中 国 的 汽车 产业 上 友 展 迅速 ， 已 经 成 为 我 国 国民 经 济 的 文 柱 产 业 之 一 。 随 着 家 庭 平均 汽车 保有 量 的 迅速 增长 ， 汽 车 给 整个 社会 市 来 的 能 源 、 环 境 、 交 通 
和 安全 的 压力 日 益 加 大 。 尽 管 汽车 在 轻 量 化 、 电 动 化 、 排 放 控 制 技 术 和 安全 技术 方面 已 经 有 了 长 足 的 进步 ， 尤 其 是 近 几 年 互联 网 和 通信 技术 在 汽车 的 独立 
特 驶 和 智能 化 方向 提供 了 极 大 的 发展 和 创新 的 空间 ， 但 诸多 的 发 展 给 汽车 产业 融 来 无 限 的 挑战 和 机 遇 。 因 此 ， 行 业 的 快速 变化 急需 培养 一 大 批 不 仅 懂 专业 
技术 ， 更 熟悉 跨 界 知 识 的 创新 型 人 才 。 


重庆 大 学 汽车 协同 创新 中 心 认识 到 人 才 培 养 的 迫切 需求 ， 组 织 我 们 为 新 成 立 的 汽车 学 院 编 写 一 套 教材 。 参 与 这 套 教材 编写 的 所 有 作者 都 身 在 汽车 行业 
的 科研 和 技术 开 友 的 第 一 线 ， 其 中 大 部 分 作者 是 近年 海归 的 年 轻 博 士 。 教 材 的 选 题 经 过 专家 人 在 传统 学 科 和 新 兴学 科 中 反复 地 论证 和 研讨 ， 选 选 了 汽车 行业 
面临 紧 担 挑战 性 的 技术 和 话题 。 第 一 批 教 材 有 八 本 ,包括 《汽车 材料 及 轻 量 化 趋势 》 《汽车 设计 的 耐久 性 分 析 》《 汽 车 动力 忌 成 现代 技术 》《 汽 车 安全 的 
仿真 与 优化 设计 》《 汽 车 尾气 净化 处 理 技术 》《 智 能 汽车 关键 技术 与 设计 方法 》《 中 国 汽车 二 氧化 碳 减 排 路 径 》 和 《电动 汽车 前 沿 反 术 及 应 用 》.。 


这 套 教 材 的 一 个 共同 特点 就 是 与 国际 友 展 同步 、 内 容 新 床 。 编 著者 对 于 比较 传统 的 学 科 ， 在 编写 过 程 中 尽 可 能 地 把 最 新 的 技术 和 理念 包括 进去 ， 比 如 
在 编写 《汽车 材料 及 轻 量化 趋势 》 的 过 程 中 ， 不 仪 介绍 了 各 种 轻 量化 材料 的 特点 和 动向 ， 而 且 强 调 了 轻 量化 材料 的 应 用 必须 系统 地 考虑 材料 的 性 能 、 部 件 
的 加 工 方法 和 成 本 。 有 些 选 题 针对 汽车 行业 及 展 的 新 的 技术 动向 ， 比 如 《汽车 安全 的 仿真 与 优化 设计 》 主 要 介绍 汽 千 安全 仿真 的 模型 验证 和 优化 ， 这 是 汽 
车 产品 开发 采用 电子 认证 的 必 经 之 路 。《 电 动 汽车 前 沿 技术 及 应 用 》 前 述 了 现代 电动 汽车 的 基本 原理 、 关 键 技术 ， 以 及 锂电 池 汽车 和 和 氢 燃 料 电池 汽车 在 未 
来 友 展 中 的 优势 和 挑战 。《 智 能 汽车 关键 技术 与 设计 方法 》 对 智能 汽车 的 感 名 、 控 制 、 定 位 和 测试 验证 等 天 键 技术 进行 了 详尽 的 分 析 与 解释 ， 并 运用 实验 
与 仿真 来 论证 书 中 所 提出 方法 的 正确 性 和 实际 可 行 性 。 


这 套 教 材 的 另 一 个 突出 的 特点 是 实用 ， 比 如 一 般 汽 车 设计 要 求 非 磨 损 件 的 寿命 是 24 万 干 米 。《 汽 车 设计 的 耐久 性 分 析 》 着 重 介 绍 了 汽车 行业 用 于 耐久 
性 分 析 的 主要 工具 和 方法 ， 以 及 这 些 方法 的 理论 基础 。 这 是 进行 汽车 整 车 和 零 部 件 寿命 耐久 性 正 向 设计 的 基础 。 随 着 环境 保护 的 法 规 日 益 严 格 ,汽车 排放 
控制 技术 也 在 不 断 友 展 提 高 。 汽 车 动力 技术 已 经 形成 化 石 燃料 到 其 他 燃料 的 多 元 化 友 展 ，《 汽 车 尾气 净化 处 理 技术 》 和 《中 国 汽车 二 氧化 碳 减 排 路 径 》 介 
绍 了 排放 控制 技术 的 进程 和 法 规 实施 的 协调 ， 以 及 达到 法 规 要 求 的 不 同 技术 路 线 。 

本 套 丛 书 不 仅 对 汽车 专业 的 学 生 大 有 神 益 ， 也 可 以 作为 汽车 从 业 人 员 和 所 有 对 汽车 技术 感 兴趣 者 的 参考 读物 。 由 于 时 间 有 限 ， 选 题 的 范围 还 不 全 面 。 
每 本 书 的 内 容 也 会 有 反映 出 作者 的 知识 和 经 验 的 局 限 性 。 在 此 ， 真 诚 地 希望 广大 读者 提出 意见 ， 供 我 们 不 断 修改 和 完善 。 


作 信 十 


2016 年 8 月 5 日 


推荐 序 一 


随 着 我 国 汽车 工业 的 快速 友 展 ， 先 进 的 汽车 设计 理论 和 技术 在 车 身 开 友 中 越 来 越 受到 重视 。 同 时 ， 汽 车 友 展 遇 到 了 环保 、 能 源 、 交 通 等 各 个 万 面 的 诸 
多 问题 ， 在 这 种 新 形势 下 ， 从 业者 擎 握 和 熟练 运用 核心 设计 技术 显得 尤为 重要 。 

汽车 的 设计 与 制造 是 一 个 非常 复杂 的 系统 工程 ， 需 要 考虑 零件 、 子 系统 、 系 统 ， 乃 至 整 车 等 各 个 层面 ， 综 合 运 用 材料 科学 、 能 源 科学 、 信 息 科学 和 制 
造 科学 的 相关 知识 、 理 论 和 方法 。 本 套 “汽车 工程 专业 系列 从 书 ” 涵 苹 了 汽车 制造 系统 和 质量 、 汽 车 动力 忌 成 、 汽 车 材料 及 轻 量 化 、 和 车身 耐 久 性 、 汽 车 安 
全 仿真 与 优化 、 汽 车 系统 控制 及 其 智能 化 、 汽 车 尾气 排放 处 理 与 二 氧化 碳 减 排 等 多 个 万 面 的 内 容 ， 涉 及 汽车 轻 量 化 、 安 全 、 环 保 、 电 子 控制 等 关键 技术 。 

本 套 丛 书 的 作者 既 有 在 汽车 相 天 领域 工作 多 年 、 有 丰富 经 验 的 专家 ， 也 有 学 成 回国 、 已 新 露头 角 的 后 起 之 秀 ; 内 容 安 排 上 既 有 适合 初学 者 学 习 的 大 量 
基础 理论 知识 ， 也 融入 了 编著 者 在 相关 领域 多 年 来 的 研究 体会 和 经 验 ， 从 中 我 们 能 充分 体会 到 现代 汽车 拉 术 节能 、 环 保 和 智能 化 的 友 展 趋 势 。 从 书 结合 
量 实例 ， 取 材 丰 语 、 图 文 并 成。 


本 套 从 书 可 作为 汽车 设计 的 参考 工具 ， 也 可 作为 车 辆 工程 、 机 械 工 程 、 环 境 工程 等 专业 研究 生 的 专 | ] 教 材 及 学 习 参 考 书 。 相 信 该 书 对 于 汽车 行业 相关 
领域 的 研究 生 、 企 业 研 友 人 员 和 科研 工作 者 会 产生 重要 的 局 友 作 用 ， 特 作 序 推荐 。 


舍 岂 多 


推荐 序 二 


作为 《中 国 制 造 2025》 战 略 部 署 的 主要 支 上 之 一 ， 汽 车 业 的 持续 、 快 速 、 健 康 友 展 将 为 中 国 制造 业 强国 目标 莫 定 坚实 的 基础 。 面 对 中 国 汽车 产业 大 而 
不 强 的 现状 ， 目 主 品牌 汽车 产业 的 友 展 壮大 时 不 我 待 。 重 庆 上 自主 品牌 汽车 协同 创新 中 心 ， 立 足 于 重庆 地 区 汽车 产业 ， 依 托 国家 “2011 计 划 ”， 以 我 国 自 主 
品牌 汽车 友 展 重大 需求 为 牵引 ， 以 体制 机 制 创新 为 手段 ， 探 索 我 国 汽车 自主 品牌 的 友 展 模式 。 中 心 面向 国内 自主 品牌 汽车 产业 ， 重 点 开展 培养 高 端 人 才 ， 
汇聚 优秀 团队 ， 研 友 核 心 技术 ， 推 广 产 业 应 用 ， 整 合 优势 资源 ， 搭 建交 流 平 台 等 工作 。 重 庆 自主 品牌 汽车 协同 创新 中 心 脑 准 “节能 环保 、 安 全 可 靠 、 智 能 
舒适 ”的 国际 汽车 三 大 发 展 趋势 ， 凝 练 学 科 友 展 万 向 ,汇聚 创 新 资源 和 汽车 及 相关 领域 的 优势 学 科 群 ， 建 六 了 全 面 泣 茧 汽车 行业 研究 错 域 的 创新 团队 。 本 
套 丛书 由 汽车 中 心 特别 顾问 、 福 特 汽 车 亚太 区 技术 总 监 韩 维 建 博士 积极 推动 。 丛 书 主编 韩 维 建 博士 基于 数 十 年 国际 一 流 汽 车 工程 经 验 以 及 独到 全 面 的 行业 
技术 趋势 把 握 ， 整 合 及 组 建 了 编著 团队 进行 从 书 各 个 书籍 的 编著 。 编 车 团队 的 成 员 主 要 由 具有 多 年 国际 汽车 公司 工作 经 验 ， 并 且 在 高 校 及 企业 科研 一 线 工 
作 的 归 国 人 员 组 成 。 从 书 内 容 拥 有 立足 成 熟 技 术 、 紧 跟 国 际 前 治 、 把 握 领 域 创新 的 特点 及 优势 ， 从 书 的 成 功 出 版 将 为 国内 汽车 行业 及 学 科 提 供 全 面 而 翔实 
的 参考 材料 。 


书籍 是 知识 传播 的 介质 ， 也 是 人 才 培 养 及 创新 意识 传承 的 基础 。 正 如 重庆 大 学 建 校 宣言 “人 类 之 文 野 ， 国 家 之 理 乱 ， 悉 以 人 才 为 其 主要 之 因 ” 所 阐释 
的 ， 本 套 从 书 秉承 重庆 目 主 品牌 汽车 协同 创新 中 心 人 才 培 养 万 针 ， 主 要 面 同 高 校 汽 车 相关 学 科 本 科 及 研究 生 的 教学 ， 同 时 也 可 为 汽车 行业 工程 人 员 参 考 。 
相信 本 套 从 书 会 对 我 国 汽车 领域 学 科 及 行业 产生 积极 恨 好 的 推动 作用 |。 
ei 


江苏 省 产业 技术 研究 院 


随 厦 汽 车 工业 和 人 工 智能 技术 的 及 展 ， 智 能 汽车 正 向 人 类 走 来 。 这 一 技术 的 普及 ， 将 从 根本 上 改变 人 类 的 生活 。 在 智能 汽车 时 代 ， 出 行 变 得 更 加 安 
人 全、 便捷、 舒适 。 人 机 共 驾 和 目 动 驾驶 将 改变 人 类 的 时 空 观 念 ， 城 市 布局 将 重新 规划 ， 共 享 经 济 大 力 友 展 ， 全 职 司机 由 虚拟 雪 驶 人 着 代 。 智 能 汽车 技术 作 
为 一 种 划时代 的 技术 ， 目 前 已 经 上 升 到 国家 战略 层面 。 智 能 汽车 产业 是 《中 国 制造 2022》 和 《国家 中 长 期 科学 和 技术 友 展 规划 纲要 (2006 一 2020 年 ) 》 
的 首选 产业 。 在 这 样 的 时 代 背 景 下 ， 本 书 将 从 技术 层面 ， 对 智能 汽车 的 感知 、 控 制 、 定 位 和 测试 验证 等 多 种 关键 技术 进行 详尽 的 分 析 与 解释 ， 并 运用 相关 
的 实验 与 仿真 来 论证 本 书 中 所 提 方 法 的 正确 性 和 实际 可 行 性 。 


本 书 第 1 章 回顾 了 智能 汽车 的 友 展 历程 和 现状 ,并 从 个 人 、 交 通 系 统 和 社会 等 不 同 层面 分 析 了 智能 汽车 的 意义 ,介绍 了 智能 汽车 主要 的 友 展 路 线 和 趋 
势 。 第 2 章 以 智能 汽车 系统 构 染 为 对 象 ， 曾 述 了 智能 汽车 的 基本 构架 与 构建 方法 ， 并 分 别 从 硬件 构架 和 软件 构架 两 个 角度 探讨 了 智能 汽车 的 基础 软 硬 件 模 
块 。 第 3 章 着 重 介 绍 了 智能 汽车 环境 感知 技术 ， 从 道路 的 理解 到 车 辆 的 识别 ， 从 机 器 学 习 再 到 深度 学 习 ， 提 出 了 相关 的 具体 解决 方法 ， 并 通过 实验 进行 了 可 
行 性 验证 。 第 4 章 从 智能 汽车 控制 的 角度 出 友 ， 介 绍 了 智能 汽车 么 急 控 制 荣 略 ， 在 理论 上 进行 了 详尽 的 分 析 与 论证 ， 提 出 了 相 天 的 控制 生 略 ， 并 通过 仿真 验 
证 了 策略 的 有 效 性 和 可 靠 性 。 第 5 章 针对 智能 汽车 的 导航 定位 技术 ， 从 高 精 地 图 、DR 到 视 竞 里 程 计 ， 重 点 介绍 了 基于 DR 与 地 图 匹配 相 结合 的 导航 定位 方 
法 。 第 6 章 介 绍 了 智能 汽车 的 测试 方法 ， 分 析 了 现行 撤 术 条 件 下 国内 外 智能 汽车 测试 方法， 展示 了 当前 全 球 最 先进 的 汽车 测试 基础 设施 与 条 件 。 最 后 ， 第 7 
章 讨 论 了 智能 汽车 友 展 所 面临 的 挑战 和 未 来 的 及 展 趋势 。 

本 书 由 王 科 和 李 霖 合作 完成 ， 作 者 尽 最 大 努力 将 对 智能 汽车 的 理解 和 经 验 融入 书 中 。 感 谢 张 餐 、 黄 奢 对 资料 整理 、 文 字 翻 译 及 校对 方面 做 出 的 协助 。 
本 书 作 为 参考 书籍 ， 主 要 面向 遍 校 相关 专业 的 学 生 和 从 事 智 能 汽车 相 天 行业 的 工程 师 。 由 于 时 间 仓 促 和 作者 的 阅历 局 限 ， 本 书 的 中 漏 和 不 妥 忆 处 在 所 难 
免 ， 欢 迎 读者 提出 批评 和 修改 意见 。 


王 科 


随 着 人 工 智 能 、 互 联网 技术 的 友 展 ， 智 能 汽车 正在 逐渐 向 人 类 走 来 。 由 于 智能 汽车 具有 智能 化 、 网 联 化 、 节 能 环保 、 安 全 便捷 等 特点 ， 对 它 的 研究 已 
经 在 汽车 产业 中 掀起 了 一 阵 热 潮 ， 它 也 将 是 未 来 汽车 发 展 的 必然 方向 。 它 的 出 现 、 普 及 将 彻底 颠覆 人 们 的 出 行 方式 ， 重 新 定义 汽车 的 属性 ， 将 人 们 从 驾驶 


中 解放 出 来 ， 并 自动 安全 地 将 乘客 送 往 目 的 地 。 现 今 各 大 企业 都 开始 投身 智能 汽车 产业 ， 相 互 竞争 合作 ， 制 订 相 天 的 战略 计划 ， 研 制 、 测 试 自家 的 智能 汽 
车 。 目 前 ， 智 能 汽车 产业 正 呈 现 出 百 家 争 奇 、 迁 勃 向 上 的 上 太 展 态势 ， 同 时 这 也 是 一 场 没 有 硝烟 的 战争 ， 任 何 企业 在 技术 上 迟滞 落后 都 可 能 被 行业 淘汰 。 


1.1 智能 汽 于 的 拉 展 和 现状 

智能 汽车 是 一 种 通过 车 载 传 感 系统 来 感知 车 辆 的 状态 和 道路 环境 ， 自 动 规划 行车 路 线 并 自主 控制 行驶 到 达 目的 地 的 车 辆 ， 是 一 种 智能 的 移动 终端 。 它 
综合 应 用 了 计算 机 技术 、 感 测 技术 、 通 信 技 术 、 人 工 智能 技术 等 ， 涉 及 人 、 车 、 路 多 方 信息 的 交互 ， 需 要 云端 在 线 服 务 平台 的 支持 [1] 。 

从 汽车 诞生 开始 ， 几 乎 同时 人 们 也 诞生 了 自动 驾驶 的 梦想 ， 渴 望 从 驾驶 工作 中 解脱 出 来 。1925 年 ， 世 界 上 第 一 辆 自动 驾驶 汽车 “Linrrican 


Wonder” 在 纽约 街头 行驶 ( 见 图 1-1) ， 它 通过 无 线 电 实现 对 车 辆 方向 盘 、 离 合 器 和 制动器 等 部 件 的 操控 “| 。 此 次 行驶 象征 着 智能 汽车 技术 成 功 地 迈 出 
了 第 一 步 ， 拉 开 了 智能 汽车 技术 的 历史 帷幕 。 





图 1-1 第 一 辆 自动 驾驶 汽车 


20 世 纪 90 年 代 示 期， 美国 国防 部 门 开始 了 DEMO 系列 军事 计划 ， 其 主要 目的 是 研究 无 人 车 辆 ， 发 展 无 人 战争 。 在 DEMO 计划 完成 之 后 ， 美 国 国防 高 级 
研究 计划 局 (DARPA) 又 举办 了 三 届 无 人 和 车辆 挑战 赛 ， 分 别 是 2004 年 、2005 年 的 Grand Challenge 和 2007 年 的 Urban Challenge， 在 2007 年 的 比赛 中 卡 
内 基 梅 隆 大 学 和 斯 坦 福 大 学 分 别 获得 冠军 和 亚军 ( 见 图 1-2a) ”上 3] 。 这 类 项 目 和 比赛 促进 了 智能 汽车 技术 的 发 展 、 交 流 与 创新 。 在 欧洲 有 European Land 
Robot Trail (ELBT) ， 韩 国有 现代 无 人 驾驶 汽车 竞赛 ,我 国有 中 国 智能 车 未 来 挑战 赛 、 中 国 智能 汽车 大 赛 等 。 在 2018 年 中 国 首 届 i-VISTA 自 动 驾驶 汽车 挑 
战 赛 中 重庆 大 学 获得 最 佳 技术 奖 ( 见 图 1-2b) 。 


在 智能 汽车 领域 中 ， 谷 歌 公司 在 2009 年 开始 了 自动 驾驶 项 目 ，2012 年 3 月 获得 了 内 华 达 州 颁发 的 美国 历史 上 首 个 无 人 驾驶 测试 许可 证 。 截 至 2016 年 3 
月 ， 其 自动 驾驶 里 程 已 经 达到 了 241 万 干 米 ， 在 整个 过 程 中 只 发 生 了 14 例 交通 事故 ， 而 且 其 中 的 13 例 是 对 方 的 责任 [4] 。 


a) 2007 年 卡 内 基 梅 隆 太 学 和 通用 汽车 联 


2018 年 重庆 大 学 开发 的 智能 车 
图 1-2 


其 他 如 人 福特、 宝马 、 丰 田 、 沃 尔 沃 等 车 企 ， 都 在 进行 智能 汽车 的 测试 和 研究 ， 各 企业 之 间 也 在 进行 相关 的 合作 和 战略 部 署 ， 并 计划 于 2021 年 左右 推出 





不 同 级 别 的 智能 汽车 量 产 车 辆 。 美 国政 府 在 2016 年 9 月 20 日 公布 了 全 球 首 个 无 人 驾驶 汽车 政策 文件 一 一 《联邦 自动 驾驶 汽车 政策 》， 以 促进 智能 汽车 健 
康 、 规 范 地 发 展 P] 。2017 年 7 月 11 日 ， 奥 迪 在 西班牙 发 布 了 全 球 第 一 款 实现 3 级 (美国 汽车 工程 师 学 会 (SAE) 的 分 级 ) 水 平 的 量 产 车 奥迪 A8 [6] 。 


在 国内 ， 智 能 汽车 技术 的 研究 开始 于 20 世 纪 80 年 代 。2011 年 7 月 ， 国 防 科技 大 学 和 一 汽 集团 联合 研制 的 红旗 HQ3 首 次 完成 了 从 长 沙 到 武汉 的 286 干 米 
的 高 速 全 程 无 人 驾驶 试验 ， 该 次 试验 的 成 功 标志 着 我 国 无 人 驾驶 技术 在 复杂 环境 识别 、 智 能 行为 决策 和 控制 等 方面 实现 了 新 的 技术 突破 【个 。 从 2009 年 开 


始 ， 国 家 自然 科学 基金 委员 会 开始 组 织 举 办 中 国 智 能 车 未 来 挑战 赛 。 该 赛事 每 年 举办 一 次 ， 成 功 吸引 了 各 大 高 校 和 相关 机 构 的 参与 ， 促 进 了 智能 汽车 技术 
的 交流 和 发 展 ， 扩 大 了 智能 汽车 技术 在 中 国 的 影响 。 

2016 年 4 月 ， 长 安 汽车 成 功 完成 了 历经 多 省 约 2000 干 米 的 自动 驾驶 测试 ， 在 实现 高 速 驾驶 的 同时 ， 还 实现 了 全 速 自 适应 巡航 、 交 通 拥堵 辅助 、 自 动 紧 
急 刹 车 、 交 通 标志 识别 等 功能 ( 见 图 1-3) ， 长 安 汽车 希望 在 两 三 年 内 将 智能 汽车 推 向 量 产 [8] 。 吉 利 汽 车 提出 了 “智能 驾驶 技术 G-Pilot” 战略， 该 战略 
是 以 适应 市 场 需求 为 导向 、 以 分 阶段 的 智能 驾驶 演化 路 径 为 指导 、 以 平台 化 配置 架构 为 方案 的 智能 驾驶 技术 10 年 路 线 图 。 自 2014 年 的 博 瑞 车 型 开始 ， 吉 利 
汽车 预计 在 2020 年 后 实现 高 度 自动 驾驶 ，2024 年 后 将 G-Pilot 系 统 推 向 新 的 高 度 。 另 外 ， 吉 利 汽车 还 和 沃尔沃 联合 打造 国际 领先 、 国 内 一 流 的 无 人 驾驶 试 


验 场 9] 。 





图 1-3 长安 自动 驾驶 汽车 


2015 年 12 月 ， 百 度 智 能 汽车 在 北京 完成 了 高 速 路 段 的 测试 ， 这 是 百度 在 宝马 汽车 的 基础 上 改装 的 第 一 代 智能 汽车 【10] 。2017 年 4 月 ， 百 度 还 向 全 球 
宣布 了 阿波 罗 计 划 ， 该 计划 预备 向 智能 汽车 领域 免费 提供 新 的 平台 ， 包 括 车 辆 平台 、 软 件 平台 、 硬 件 平台 和 云端 数据 四 大 部 分 ， 并 逐步 开放 其 智能 汽车 的 
相关 源 代码 ， 降 低 智能 汽车 的 研发 成 本 。 截 至 2017 年 7 月 5 日 ， 百 度 阿 波 罗 计 划 已 经 有 了 53 家 合作 伙伴 ， 包 括 汽车 企业 、 核 心 零件 供应 商 、 地 图 公司 、 出 行 
服务 公司 以 及 高 校 等 ( 见 图 1-4) 。 该 战略 计划 已 经 取得 了 阶段 性 成 果 ， 将 促进 智能 汽车 技术 的 快速 发 展 【11] 。 
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图 1-4 百度 阿波 罗 计划 部 分 合作 伙伴 
2015 年 国务 院 正式 印发 了 《中 国 制 造 2025》， 该 战略 是 我 国 为 实现 制造 强国 的 地 位 而 颁布 的 第 一 个 十 年 纲领 。 节 能 和 新 能 源 汽车 是 其 中 的 重要 部 分 ， 
要 努力 实现 汽车 的 电动 化 、 低 碳化 、 信 息 化 、 智 能 化 ， 加 速 自主 品牌 形成 从 零 部 件 到 整 车 的 生产 工业 体系 和 核心 竞争 力 ， 缩 短 与 先进 国家 间 的 差距 。2016 
年 ， 国 家 制造 强国 建设 战略 咨询 委员 会 受 工业 和 信息 化 部 委托 ， 正 式 发 布 了 “节能 与 新 能 源 汽车 技术 路 线 图 ” [<] 。 该 路 线 图 规划 了 未 来 15 年 间 我 国 智 
能 网 联 汽车 的 发 展 方向 与 框架 ， 由 辅助 驾驶 、 部 分 自动 驾驶 逐步 过 渡 到 高 度 或 完全 自动 驾驶 ( 见 图 1-5) 。 预 计 到 2020 年 ， 汽 车 产业 规模 达到 3000 万 辆 ， 
带 有 先进 辅助 驾驶 系统 或 部 分 自动 驾驶 车 辆 的 市 场 份额 达到 50%。 
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图 1-5 每 能 网 联 汽车 发 展 路 线 图 
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1.2 ”智能 汽 千 的 意义 


目前 智能 汽车 技术 正 逐 渐 从 想象 变 成 现实 ， 正 从 以 科技 为 主导 的 研 友 阶段 向 如 何 普及 推广 的 市 场 化 阶段 过 渡 。 它 的 市 场 化 使 用 最 终 将 彻底 颠覆 人 类 的 
出 行 方式 。 人 类 可 以 从 繁重 的 驾驶 劳动 中 解放 出 来 ， 不 必 化 费 精力 关注 车 辆 及 道路 的 状态 。 智 能 汽车 的 发 展 和 整个 社会 写 人 类 智能 化 进程 相符 合 ， 是 社会 
发 展 进步 的 必然 选择 。 下 面 本 书 将 从 个 人 、 交 通 系 统 以 及 社会 三 个 层面 分 别论 述 智能 汽车 的 影响 和 意义 。 


1.2.1 智 舱 ) 气 车 对 个 人 的 意义 


智能 汽车 最 直接 的 意义 就 是 将 人 从 繁重 枯燥 的 驾驶 劳动 中 解脱 出 来 。 只 需要 为 它 提供 目的 地 ， 就 可 以 完全 地 将 驾驶 任务 交 给 汽车 。 这 样 一 来 既 减 少 了 
驾车 的 疲劳 和 厌倦 ， 又 不 必 担 心 堵车 拥挤 问题 ， 另 外 也 蔬 约 了 加 车 的 时 间 ， 可 以 在 旅途 中 享受 休闲 娱乐 甚至 继续 办 公 ， 更 加 上 自由 随 性 。 同 时 ， 无 人 驾驶 汽 
车 对 于 未 来 社会 人 口 老 龄 化 有 重大 的 意义 ， 在 未 来 几 十 年 内 ,全球 老龄 化 的 趋势 将 越 来 越 明显 ， 年 长 的 司机 越 来 越 多 ， 其 各 车 的 反应 能 力 和 敏捷 性 都 将 下 
降 ， 这 对 于 人 的 生命 安全 形成 了 巨大 的 威胁 。 当 智能 汽车 投入 使 用 后 ， 它 们 对 于 使 用 人 员 的 要 求 更 低 ， 老 人 人、 儿童 甚 全 是 残疾 人 等 轨 驶 能 力 弱 或 是 无 轨 驶 
能 力 的 弱势 群体 ， 都 可 以 通过 智能 汽车 方便 出 行 


1.2.2 智 稻 和 气 车 对 交通 系统 的 意 


智能 汽车 技术 是 智能 交通 系统 的 重要 组 成 部 分 ， 该 技术 能 够 有 效 地 降低 交通 事故 发 生 率 ， 提 升 汽车 行驶 的 安全 性 、 和 舒适 性 和 快捷 性 [1 3] 。 权 威 数据 显 
示 ， 全 球 每 年 约 有 130 万 人 死 于 交通 事故 ， 有 90% 的 事故 与 人 的 失误 行为 有 关 [4] 。 人 的 操作 和 失误 导致 了 大 量 的 交通 事故 ， 所 以 减少 人 的 操作 和 失误 可 
以 大 幅度 减少 交通 事故 的 发 生 。 当 自动 驾驶 取代 有 人 驾驶 ， 智 能 汽车 的 精准 控制 有 可 能 实现 零 交 通 事故 的 情况 。 另 外 智能 汽车 可 以 相互 交换 数据 ， 了 解 彼 
此 的 驾驶 意图 ， 再 结合 大 数据 和 云 平 台 服 务 ， 了 解 道路 网 络 的 情况 ， 因 此 智能 汽车 可 以 做 出 更 好 的 路 径 规划 ， 从 而 避免 交通 拥堵 。 同 时 ， 智 能 交通 系统 也 
可 以 根据 道路 网 络 中 车 辆 的 数据 而 做 出 相应 的 改变 来 缓解 交通 拥堵 ， 比 如 将 红绿灯 的 固定 间隔 时 间 变 成 动态 的 ， 实 时 根据 相应 路 口 车 辆 流量 的 大 小 来 设计 
间隔 时 间 以 提高 效率 。 由 于 智能 汽车 的 控制 准确 ， 车 距 可 以 减 小 ， 从 而 提高 车 流通 量 ， 道 路 可 以 不 必 为 了 缓解 交通 问题 而 修建 得 更 加 宽阔 ， 从 而 提高 土地 


的 使 用 率 。 据 高 盛 公司 和 美国 《经 济 学 人 》 杂 志 报 道 ，24% 的 城市 土地 空间 用 于 停车 由 >?] 。 智 能 汽车 通过 云 平 台 可 以 更 好 地 自动 分 配 汽车 的 停车 问题 ， 使 
得 汽车 可 以 更 加 充分 地 利用 各 停车 场 的 资源 ， 减 少 停车 场 的 建设 。 


1.2.3 ”智能 汽 后 对 储 会 的 最 义 


智能 汽车 的 使 用 将 会 提高 社会 智能 化 的 程度 ， 推 动人 类 进入 智能 化 时 代 ， 缓 解 现 今 的 能 源 危机 和 环境 污染 等 问题 。 根 据 公 安 部 交管 局 统计 ， 截 至 2016 
年 年 底 ， 全 国 机 动车 保有 量 达 2.9 人 Z 辆 ， 其 中 汽车 达 1.94 亿 辆 [16] 。 如 此 巨大 的 汽车 保有 量 对 石油 的 需求 巨大 ， 将 产生 大 量 的 污染 物 及 温室 气体 。 当 智能 
汽车 投入 使 用 后 ， 更 少 的 交通 拥堵 将 提高 燃油 利用 率 ， 更 好 的 路 线 规划 将 缩短 驾驶 的 里 程 数 ， 更 加 准确 的 车 辆 控制 将 降低 驾驶 员 因 操 纵 失 误 增 加 的 油耗 ， 
这 些 优势 都 将 降低 对 石油 的 需求 ， 从 而 减少 汽车 尾气 污染 物 以 及 温室 气体 的 产生 ， 对 环境 更 友好 。 根 据 谷歌 无 人 驾驶 汽车 团队 的 统计 ， 当 前 传统 汽车 96% 
的 时 间 都 处 于 空闲 状态 【17/] 。 共 享 智能 汽车 的 模式 将 会 减少 车 辆 的 保有 量 ， 提 高 能 源 和 车 辆 的 利用 效率 ， 减 少 排放 。 


1.3 ” 千 能 汽车 的 分 级 


根据 汽车 自动 化 程度 的 不 同 ， 智 能 汽车 可 分 成 不 同 的 等 级 。 其 主要 的 分 级 标准 有 两 种 ， 即 美国 国家 公路 交通 安全 管理 局 (NHTSA) 发 布 的 0 ~ 4 级 标准 
和 美国 汽车 工程 师 学 会 (SAE) 发 布 的 0 ~ 5 级 标准 [18] ， 两 者 的 对 比如 表 1-1 所 示 。 


表 1-1 NHSTA 和 SAE 分 级 对 比 自动 驾驶 分 级 


自动 驾驶 分 级 | 名 称 
NHTSA|SAE 
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从 表 中 可 以 看 出 ， 两 者 的 标准 基本 一 致 。SAE 将 NHTSA 的 完全 和 目 动 驾驶 (4 级 ) 分 为 高 度 自动 化 驾驶 (4 级 ) 和 完全 自动 化 驾驶 (5 级 ) 两 个 等 级 ,更 
加 细 化 了 高 度 自 动 加 驶 的 分 类 。 目 前 在 智能 汽车 领域 中 ， 人 们 更 倾向 于 使 用 SAE 的 智能 汽车 等 级 划分 标准 。 


在 两 者 的 智能 汽车 分 类 中 ，0 ~ 2 级 属于 先进 驾驶 辅助 系统 (ADSA) ， 主 要 由 人 来 观察 环境 。 根 据 系 统 对 于 车 辆 的 方向 盘 和 加 减速 是 否 具 有 控制 功 
能 ， 将 其 分 为 0、1 和 2 三 个 等 级 。 在 SAE 的 标准 中 3 ~ 5 级 属于 自动 驾驶 系统 ， 主 要 由 机 器 来 感知 环境 。 根 据 驾 驶 员 需 要 提供 的 应 答 程 度 、 车 辆 适用 的 条 件 和 
范围 ， 将 其 分 为 3、4 和 5 三 个 等 级 。 


0 级 : 系统 对 于 车 辆 运动 无 控制 权 ， 和 车 辆 的 驾驶 全 权 由 人 负责 ， 无 目 动 化 。 系 统 只 能 通过 车载 传感器 探测 、 感 知 周转 环境， 进行 决策 报 营 。 比 如 车 道 偏 
离 报 警 、 倒 车 防 撞 雷达 和 前 车 防 撞 预警 等 ， 都 只 是 借助 报警 来 提醒 、 帮 助 驾驶 员 更 好 地 驾驶 。 


1 级 : 系统 对 于 车 辆 的 万 同 盘 或 者 加 减速 有 单一 的 控制 权 ， 功 能 比较 单一 ， 无 法 做 到 对 两 者 同时 控制 ， 驾 驶 员 的 手 和 脚 不 能 同时 放松 。1 级 包括 目 适 应 
巡 般 控制、 紧急 刹车 辅助 等 。 


2 级 : 系统 可 以 同时 对 方向 盘 和 加 减速 进行 多 项 操作 ， 使 得 在 一 定 条 件 下 ， 驾 驶 员 可 以 从 驾驶 中 解放 出 来 ， 此 时 竹 辆 具有 部 分 目 动 化 驾驶 功能 。2 级 包 


括 全 自动 跟随 、 车 道 保 持 与 跟踪 等 。 

3 级 : 系统 将 会 完成 所 有 车 辆 操作 ， 在 某 些 特定 条 件 下 可 以 实现 自动 驾驶 ， 在 紧急 情况 下 ， 由 人 进行 认 知 判别 和 干预 。 当 系统 发 出 接管 请 求 时 ， 驾 驶 员 
需要 给 予 系统 支援 。3 级 包括 拥挤 辅助 驾驶 功能 、 自 动 泊 车 系统 等 。 

4 级 : 车 辆 具有 高 度 自动 化 ， 可 以 完成 特定 条 件 下 的 全 部 任务 ， 但 在 极端 的 环境 下 车 辆 无 法 完成 驾驶 。3 级 与 4 级 自动 化 系统 的 差异 在 于 后 者 能 够 不 依 
赖 驾 驶 员 进入 最 小 风险 模式 ， 而 前 者 不 能 可 靠 地 执行 | “】。4 级 包括 景区 或 工业 园区 内 的 自动 驾驶 、 高 速 公 路 上 的 高 度 自动 驾驶 等 。 


5 级 : 车 辆 具有 完全 的 自动 化 ， 不 再 局 限于 某 一 区 域 ， 可 以 完成 所 有 条 件 下 的 全 部 任务 ， 这 是 智能 汽车 的 最 终 目标 ， 人 类 可 以 安全 地 从 驾驶 中 解脱 出 来 
而 不 必 关 注 车 辆 的 状态 。 只 需要 告诉 车 辆 目的 地 ， 智 能 汽车 便 可 以 自动 安全 地 到 达 目 的 地 .。 


1.4 智能 汽车 的 天 键 技术 


对 于 智能 汽车 而 言 ， 其 天 键 技 术 包 括 以 下 几 部 分 : 传感器 部 分 、 计 算 系 统 、 车 辆 硬件 平台 以 及 云端 平台 。 传 感 器 部 分 是 智能 汽车 的 感知 基础 ， 系 统 通 
过 传感器 采集 车 辆 和 环境 的 数据 ， 实 现 车 辆 的 感知 ;计算 系统 包括 计算 机 硬件 部 分 和 软件 部 分 ， 通 过 对 传感器 数据 进行 处 理 ， 结 合 V2X 车 联网 及 云端 数据 
做 出 决策 、 规 划 和 控制 ， 云 端 平台 包括 对 于 数据 的 存储 、 模 拟 、 高 精 地 图 的 绘制 与 更 新 以 及 深度 学 习 模 型 训练 ， 它 能 为 行驶 中 的 智能 汽车 提供 相关 的 数 
据 ， 帮 助 其 做 出 更 好 的 规划 与 控制 ， 同 时 也 能 够 更 新 高 精 地 图 并 训练 更 加 有 效 的 识别 、 跟 踪 和 决策 模型 “0] 。 自 动 驾 驶 系统 构架 图 如 图 1-6 所 示 。 


智能 汽车 的 关键 技术 包括 传感器 、 环 境 感 和 、 和 车辆 定位 、 路 径 规划 、 和 车 辆 控制 系统 、 高 精 地 图 等 各 方面 的 技术 ， 技 术 细 节 将 在 后 续 内 容 中 进行 详细 介 





图 1-6 ”自动 驾驶 系统 构架 图 


1.5 ”智能 汽车 的 技术 路 线 


现 如 今 涉足 智能 汽车 领域 的 不 仅 有 传统 和 新 兴 的 车 企 ， 还 有 相关 的 零 部 件 供应 商 以 及 跨 界 的 科技 公司 。 目 前 智能 汽车 技术 正 处 于 友 展 探索 阶段 ， 在 技 
术 路 线 上 存在 多 种 可 能 ， 并 没有 一 条 大 家 都 比较 认同 的 路 线 。 由 于 各 个 企业 的 经 验 、 资 金 和 技术 水 平等 不 同 ， 所 以 各 个 企业 都 有 自己 倾向 的 技术 路 线 。 


传统 的 车 企 倾 向 于 通过 技术 的 不 断 罕 积 、 测 试 数据 的 不 断 增 加 、 场 景 的 不 断 丰 富 ， 逐 步 从 先进 各 驶 辅助 系统 过 渡 到 半 目 动 各 驶 ， 最 终 实 现 完全 目 动 各 
驶 。 而 某 些 跨 界 的 科技 公司 则 借助 其 在 数据 采集 处 理 、 算 法 、 硬 件 平台 、 人 工 智能 等 方面 的 优势 ， 直 接 跨越 到 高 等 级 自动 驾驶 的 阶段 [*1]。 例 如 现 如 今 各 


大 传统 车 企 借助 其 在 整 车 方面 的 优势 ， 都 积极 推出 配备 有 相应 的 驾驶 辅助 系统 、 部 分 目 动 化 驾驶 系统 的 车 型 。 而 打算 直接 跨越 到 自动 各 驶 的 科技 公 司 则 直 
接 开 友 4/5 级 别 的 自动 驾驶 车 辆 ， 其 直接 目的 束 是 要 实现 自动 驾驶 车 辆 的 量 产 上 市 。 


智能 汽车 在 技术 路 线 上 主要 有 两 种 方案 : 一 种 是 以 视 沉 为 主导 的 方案 (比如 特 斯 拉 ) ， 通 过 摄像 头 进行 环境 的 感知 ， 可 以 用 于 对 物体 的 识别 和 追踪 以 
及 车 辆 的 定位 。 该 路 线 使 用 的 摄像 头 价格 低廉 ,安装 方便 ， 比 较 适 用 于 目 动 只 驶 车 辆 的 量 产 。 它 的 缺点 就 在 于 算法 的 复杂 程度 较 高 ， 容 易 受 到 极端 天 气 的 
影响 ， 人 在 光 续 比较 弱 的 情况 下 效果 比较 差 。 


另 一 种 是 以 激光 雷达 (Light Detection and Ranging，LiDAR) 为 主导 (比如 谷歌 ) 的 方案 ， 通 过 激光 雷达 进行 障碍 物 的 检测 ， 借 助 激光 雷达 扫描 的 
点 云 和 高 精 地 图 的 匹配 实现 车 辆 的 定位 。 这 种 方案 可 以 解决 摄像 头 受 光线 影响 的 缺点 ， 而 且 激 光 雷 达 的 检测 范围 广 ， 准 确 度 高 ， 算 法 的 复杂 程度 相对 较 
低 。 但 是 它 也 有 缺点 ， 激 光 的 传播 速度 容易 受到 悬浮 颗粒 物 的 干扰 ， 当 空气 中 的 悬浮 颗粒 物 过 大 时 ， 其 准确 性 会 大 大 降低 。 另 外 其 价格 昂贵 ， 阻 碍 了 自身 
的 实际 应 用 。 不 过 对 于 坚持 以 激光 雷达 为 主导 的 谷歌 来 阅 ， 它 通过 自主 开发 激光 雷达 ， 将 成 本 降低 了 90%， 从 7 万 多 美元 下 降 至 7500 美 元 。 若 是 智能 汽车 
量 产 上 市 ， 该 激光 雷达 的 价格 还 会 降低 。 

由 于 各 大 企业 在 各 部 分 关键 技术 的 优势 不 同 ， 因 此 各 企业 之 间 的 合作 交流 必 不 可 少 ， 通 过 借助 其 他 企业 的 某 些 优势 技术 进行 技术 整合 ， 可 以 集中 精力 
攻克 另 一 些 技术 难关 ， 从 而 促进 智能 汽车 技术 的 进一步 发 展 。 如 美国 优 步 (Uber) 公司 与 戴 姆 勒 公司 达成 协议 ， 双 方 将 合作 探索 智能 汽车 在 共享 出 行 方面 
的 应 用 ; 福特 公司 对 人 工 智能 初创 企业 Argo Al 投资 10 亿 美元 ， 并 在 交易 完成 后 获得 后 者 的 控股 权 。Argo Al 将 专门 为 福特 公司 的 自动 驾驶 开发 软件 ， 福 特 
公司 表示 开发 的 软件 还 可 能 授权 给 其 他 公司 <<] ; 宝马 、Mobileye 以 及 英特尔 宣布 三 方 合作 ， 共 同 开发 自动 驾驶 车 辆 [3] ; 各 企业 纷纷 加 入 百度 的 阿波 
罗 战 略 计 划 ， 开 展 智能 汽车 方面 的 合作 。 各 企业 之 间 的 合作 越 密集 ， 就 越 有 利于 智能 汽车 技术 的 进步 ， 以 及 各 方 资源 的 进一步 整合 。 


1.6 智能 汽 后 时 代 的 来 | 





人 
四 


如 今 ， 以 科研 为 主 的 智能 汽车 技术 的 第 一 幕 基本 已 经 结束 ， 在 这 一 幕 中 智能 汽车 技术 主要 以 研 友 为 主 ， 并 不 考虑 成 本 ， 只 要 能 实现 目 动 驾驶 的 功能 即 
可 。 在 已 经 进入 以 市 场 为 主导 的 第 二 幕 竞 争 中 ， 人 们 需要 将 第 一 乾 的 科研 成 果 转 损 为 市 场 产品 并 推广 。 这 不 仅 涉 及 扩 术 的 友 展 ， 还 有 政府 的 文 持 、 相 天 法 
规 的 完善 、 基 础 道路 设施 的 建设 、 智 能 交通 等 相关 部 门 的 文 撑 。 另 外 ， 如 何 处 理 目 动 驾驶 车 辆 与 有 人 芭 驶 车辆 的 共存 ， 如 何 判定 目 动 轨 驶 车 辆 的 交通 事故 
责任 和 道德 ， 如 何 确保 自动 汽车 的 网 络 安全 等 问题 都 对 智能 汽车 提出 了 极 大 的 挑战 。 相 信 智 能 汽车 的 时 代 终 将 到 来 ， 只 是 这 个 过 程 肯定 会 是 曲折 艰 圣 的 ， 
还 需要 社会 各 界 、 相 关 行 业 齐头并进 、 攻 坚 克 难 。 
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第 2 章 ”智能 汽车 的 系统 构 染 与 主要 构成 


智能 汽车 是 集 计算 机 技术 、 感 测 技术 、 通 信 技 术 、 人 工 智能 以 及 决策 控制 等 多 项 技术 于 一 体 的 智能 运动 平台 ， 是 一 个 复杂 的 非 线性 系统 。 理 清 智能 汽 
车 系统 框架 ， 以 及 框架 内 各 组 成 部 分 间 的 交互 天 系 ， 对 于 理解 智能 汽车 具有 重要 意义 。 


2.1 智 衣 ; 气 车 的 系统 构 染 


从 本 质 上 来 讲 ， 智 能 汽车 是 轮 式 移动 机 器 人 的 一 种 。 因 此 ， 现 阶段 移动 机 器 人 领域 的 经 典 体系 构架 ， 也 同样 被 广泛 应 用 于 智能 汽车 ， 其 主要 包括 分 层 
递 阶 式 系统 构架 、 反 应 式 系统 构架 ， 以 及 混合 式 系统 构架 【1] 。 


2.1.1 ”分 层 递 阶 式 系 统 构 染 


分 层 递 阶 控制 理论 是 组 织 和 分 析 复 杂 系 统 时 常用 的 一 种 拷 术 手段 ， 以 分 层 弟 阶 控 制 理论 为 基础 的 分 层 递 阶 控制 系统 结构 ， 一 般 包 含 三 个 不 同 的 层级 ， 
即 组 织 级 、 协 调 级 和 执行 级 【全 ， 如 图 2-1 所 示 。 其 中 ， 组 织 级 是 最 高 的 智能 级 别 ， 主 要 负责 各 种 信息 的 融合 处 理 和 控制 决策 ， 并 向 下 对 协调 级 下 达 命 
令 ; 协调 级 是 组 织 级 和 执行 级 之 间 的 接口 ， 负 责 将 组 织 级 的 命令 分 配 为 执行 级 的 各 项 子 任务 ， 同 时 反馈 任务 执行 情况 ; 执行 级 由 若干 个 执行 器 组 成 ， 需 要 
完成 相应 的 控制 动作 ， 保 证 各 执行 器 能 准确 执行 下 达 的 相 天 命令 。 
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图 2-1 分 层 递 阶 控制 系统 结构 


依据 图 2-1 中 的 控制 系统 结构 ， 可 以 从 感知 、 规 划 以 及 控制 等 三 个 不 同 层 级 ， 建 立 起 智能 汽车 的 分 层 递 阶 式 系统 构架 ， 典 型 的 分 层 递 阶 式 系统 构架 如 图 
2-2 所 示 3] 。 这 种 感知 一 规划 一 行动 (Sense-Planning-Action，SPA) 式 系统 构架 ， 已 被 成 功 地 应 用 于 多 家 科研 机 构 研发 的 无 人 驾驶 汽车 中 ， 如 斯 坦 福 
大 学 在 2007 年 Urban Challenge 挑 战 赛 中 所 使 用 的 无 人 驾驶 汽车 。 








图 2-2 ”典型 的 分 层 递 阶 式 系统 构架 


分 层 递 阶 式 系统 构架 具有 一 系列 优点 ， 如 它 将 系统 模块 化 ， 使 得 其 设计 过 程 更 加 容易 实现 ; 模块 可 单独 调试 等 。 但 同时 它 也 存在 一 系列 缺点 ， 如 传 感 
器 数据 只 有 经 过 建 模 决 策 才能 得 到 输出 ， 所 以 该 系统 存在 延 时 间 题 。 另 外 ， 该 层级 式 捉 联结 构 也 对 系统 可 靠 性 提出 了 很 高 的 要 求 ， 一 旦 某 层级 出 现 问 题 就 
会 导致 整个 系统 的 衣 演 。 常 用 的 分 层 递 阶 式 系 统 构架 ， 如 图 2-3 所 示 。 


2.1.2 ”反应 式 系 统 构 染 


1986 年 ,布鲁克 斯 (Brooks) 以 移动 机 器 人 为 基础 ， 提 出 了 依据 行为 来 构造 层级 和 模块 的 思想 。 他 指出 对 于 面向 移动 机 器 人 的 复杂 系统 ， 分 布 式 无 中 
心 染 构 可 以 极 大 地 提高 系统 的 实时 性 和 效率 。 在 此 基础 上 ， 他 提出 了 基于 “感知 (Sense) -行动 (Action) ”并 行 映射 结构 的 反应 式 系统 构架 ， 如 图 2-4 


所 示 4' >] 。 它 针对 各 个 局 部 目标 设计 各 种 基本 行为 ， 形 成 各 种 不 同 层次 的 能 力 [] 。 
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图 2-4 基于 行为 的 反应 式 系统 构架 
在 基于 行为 的 智能 汽车 反应 式 系统 构架 中 ， 各 “感知 -行动 ” 式 任务 模块 ， 根 据 环境 数据 直接 进行 决策 ， 并 通过 内 部 通信 机 制 和 协调 机 制作 用 于 执行 结 
构 。 系 统 具有 简单 快速 、 灵 活 和 高 可 靠 性 的 优点 ， 如 大 名 昂昂 的 ROS 系 统 就 采用 了 这 种 构架 。 但 该 结构 强调 模块 间 的 独立 、 平 行 工 作 ， 缺 乏 全 局 性 的 指导 
和 协调 ， 虽 然 在 局 部 行动 上 可 显示 出 灵活 的 反应 能 力 和 鲁 棒 性 ， 但 对 于 长 远 的 全 局 性 目标 跟踪 显得 缺少 主动 性 ， 目 的 性 较 差 [6，/7] 。 


2.1.3 ”混合 式 系统 构架 


在 分 层 递 阶 式 系统 构架 中 ， 依 赖 较 多 的 是 经 过 高 级 决策 规划 后 的 有 意识 行为 ， 而 在 反应 式 系统 构架 中 ， 得 到 的 是 环境 作用 下 的 反射 行为 ， 综 合 利用 两 
者 的 优点 ， 就 可 以 得 到 混合 式 系统 构架 。 在 混合 式 系统 构架 中 ， 较 低层 次 采用 了 基于 行为 的 反应 式 系统 构架 ， 较 高 层次 采用 了 分 层 递 阶 式 系统 构架 ， 从 而 
实现 对 已 有 信息 的 有 效 利用 ， 完 成 单一 结构 无 法 实现 的 复杂 任务 [8] ， 典 型 的 混合 式 系统 构架 如 图 2-5 所 示 。 
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图 2-5 ”典型 的 混合 式 系统 构架 


在 该 混合 式 系统 构架 中 ， 框 架 主体 采 用 的 是 分 层 递 阶 式 系统 构架 ， 包 括 环境 感知 、 全 局 路 径 规 划 、 局 部 路 径 规划 和 底盘 控制 四 部 分 。 而 在 局 部 路 径 规 
划 模 块 中 ， 考 虑 到 该 模块 对 系统 有 极 高 的 实时 性 要 求 ， 为 了 适应 复杂 多 变 的 环境 ， 在 该 模块 中 采用 了 反应 式 系统 构架 ， 将 行为 决策 分 为 七 种 典型 的 行为 ， 
采用 竞争 机 制 来 完成 动作 的 决策 已] 。 混 合式 系统 构架 有 被 成 功用 在 美国 DMEO 亚 项 目 上 的 4D/RCS (Real-time Control System) 体系 构架 [0] 。 


2.2 ”智能 汽车 的 硬件 系统 构 染 


智能 汽车 的 硬件 系统 包括 传 感 系统 、 计 算 系统 和 控制 系统 ， 其 一 般 结构 如 图 2-6 所 示 【11] 。 其 中 ， 传 感 系统 是 智能 汽车 环境 感知 系统 的 硬件 基础 ， 其 
性 能 的 好 坏 将 直接 影响 智能 汽车 环境 感知 模块 的 准确 性 和 实时 性 。 计 算 系统 是 智能 汽车 数据 处 理 的 硬件 中 枢 和 大 脑 ， 负 责 及 时 高 效 地 处 理 传 感 系统 输入 的 
外 部 环境 数据 。 控 制 系统 是 智能 汽车 的 执行 基础 ， 其 执行 决策 指令 的 准确 性 和 可 靠 性 ， 决 定 了 智能 汽车 的 性 能 。 


目前 ,硬件 计算 系统 有 基于 CPU、GPU、TPU、FPGA 以 及 ASIC 等 多 种 处 理 器 的 解决 方案 【1“] ， 它 们 在 处 理 不 同 任务 时 具有 不 同 的 性 能 和 优势 ， 因 此 
计算 机 硬件 系统 正 向 多 种 处 理 器 并 存 的 异 构 方向 友 展 。 另 外 对 于 控制 系统 ， 为 了 缩短 开发 周期 ， 智 能 汽车 控制 执行 机 构 大 多 数 是 在 不 改变 现 有 汽车 执行 机 
构 的 基础 上 ， 对 传统 汽车 控制 系统 的 硬件 进行 的 设计 和 改造 。 
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图 2-6 ”智能 汽车 一 般 硬件 结构 示意 图 


2.2.1 ”智能 汽 后 计算 平台 


如 今 人 工 智 能 在 智能 汽车 技术 上 的 发 展 和 应 用 越 来 越 深 入 。 但 人 工 智 能 算法 需要 大 量 的 并 行 运 算 ， 传 统 的 串 行 处 理 器 CPU 已 经 不 能 满足 计算 的 需求 。 
因此 专业 人 士 提出 了 一 些 基 于 其 他 结构 的 计算 处 理 平台 ， 来 满足 自动 驾驶 系统 的 计算 需要 和 实时 性 ， 并 在 应 用 中 将 CPU 作为 主 处 理 器 ， 其 他 异 构 部 分 作为 
协作 处 理 器 ， 来 实现 任务 的 加 速 处 理 。 如 奥迪 A8 的 控制 器 zFAs 中 就 包括 了 四 块 高 性 能 的 处 理 器 ， 即 Mobileye 的 EyeQ3、 瑞 伟 达 (NVIDIA) 的 Tegra 
K1、 阿 尔 特 拉 (Altera) 的 Cyclone 5 和 英 飞 凌 (Infineon) 的 Aurix 等 。 


1. 基 于 GPU 的 计算 平台 


GPU 是 图 像 处理 器 的 简称 ， 专 门 用 于 图 像 的 运算 工作 。 具 有 代表 性 的 GPU 主要 以 英 伟 达 的 产品 为 主 ， 其 依靠 本 身 在 GPU 方面 的 强劲 实力 ， 推 出 了 一 个 
基于 GPU 的 智能 汽车 计算 平台 ， 即 NVIDIA DRIVE PX 平 台 ， 包 括 DRIVE PX、DRIVE PX2 以 及 在 2017 年 10 月 推出 的 DRIVE PX Pegasus 等 产品 ， 如 图 2-7 
所 示 。 





图 2-7 DRIVE PX 系列 产品 


由 于 在 浮 点 运算 、 并 行 计算 等 部 分 计算 方面 ，GPU 可 以 提供 相当 于 CPU 的 数 十 倍 乃 至 上 百倍 的 性 能 。 如 今 GPU 通 用 技术 的 友 展 在 智能 汽车 领域 已 经 得 
到 广泛 应 用 ， 比 如 用 GPU 的 心 片 来 进行 深度 学 习 模 型 的 训练 ， 用 于 智能 汽车 环境 感知 的 处 理 等 。 


2. 基 于 FPGA 的 计算 平台 


FPGA 即 现场 可 编程 门 阵列 ， 是 集成 电路 的 一 种 产物 ， 具 有 低 功 耗 、 高 性 能 的 特点 。 由 于 FPCA 是 以 门 电路 的 形式 运行 的 ， 所 以 编程 中 的 语言 在 执行 时 
直接 被 翻译 成 为 电路 ， 相 比 于 CPU 极 大 地 提高 了 运行 速度 。 同 时 FPGA 在 阿尔 特 拉 的 帮助 下 ， 增 加 了 对 OpenCL 开 发 环境 的 支持 ， 降 低 了 硬件 编程 的 门槛 。 
如 今 随 着 深度 学 习 和 神经 网 络 等 算法 在 FPGA 上 的 进一步 优化 ，FPGA 平 台 的 计算 能 力 得 到 进一步 提高 。 目 前 ， 阿 尔 特 拉 所 推出 的 基于 FPGA 的 Cylone 
59oC 的 计算 平台 已 经 成 功用 于 奥迪 A8 的 zFAs 自 动 驾驶 控制 器 中 ， 用 来 负责 奥迪 智能 汽车 的 核心 功能 ， 包 括 障碍 物 检 测 、 地 图 融合 及 各 种 传感器 的 预 处 理 
等 工作 。 可 见 ，“CPU+FPGA” 这 样 的 并 行 异 构 计算 平台 在 未 来 具有 较 好 的 友 展 前 景 。 


3. 其 他 智能 汽车 计算 平台 


当然 ， 除 了 上 面 两 种 主要 的 计算 平台 之 外 ， 还 有 一 些 其 他 的 解决 方法 ， 比 如 AsIC、TPU、 类 脑 必 片 、 概 率 心 片 等 。 这 些 计算 平台 主要 都 能 够 进行 大 量 
的 并 行 运算 ， 来 满足 智能 汽车 系统 的 运行 需求 。 


(1) ASIC 即 集成 电路 。ASIC 是 一 种 特定 的 心 片 ， 目 前 已 经 在 智能 汽车 领域 得 到 广泛 的 应 用 。 心 片 内 部 的 电路 和 算法 固化 ， 具 有 前 期 开 友 周期 长 、 投 
入 高 ， 但 体积 小 、 功 耗 低 、 计 算 效 率 高 等 特 后 ， 如 Mobileye 与 意 法 半导体 联合 研 友 的 EyeQ 系 列 心 片 。 其 中 ，EyeQ3 心 片 已 被 用 于 奥迪 A8 的 zFAS 当 中 。 公 
司 还 计划 在 2018 年 推出 更 高 性 能 的 EyeQ5 心 片 ， 该 心 片 最 多 可 以 支持 20 个 外 部 传感器 (包括 摄像 头 、 雷 达 和 激光 雷达 ) ， 而 EyeQ4 最 多 只 能 支持 8 个 传 感 
器 数据 的 处 理 。 


(2) TPU 即 张 量 处 理 单 元 。TPU ( 见 图 2-8) 是 一 种 ASIC， 是 专 为 深度 学 习 语 言 Tensor Flow 开 友 的 一 种 心 片 ， 支 持 Tensor Flow 所 有 的 指令 集 。 
TPU 可 以 像 CPU 或 GPU 一 样 编程 ， 并 在 不 同 的 神经 网 络 上 执行 CISC 指 令 ， 而 不 是 为 某 个 专用 的 神经 网 络 模 型 设计 ， 因 此 具有 一 定 的 通用 性 ， 而 且 比 CPU、 
GPU 和 FPGA 拥 有 更 高 的 效率 和 更 低 的 能 耗 。 谷 歌 曾 表 示 ， 专 用 机 器 学 习 心 片 TPU 处 理 速度 要 比 GPU 和 CPU 快 15 ~ 30 倍 (和 英特尔 Haswell CPU、 英 伟 达 
Tesla K80GPU 相 比 ) ， 而 在 能 效 上 ，TPU 更 是 提升 了 30~ 80 倍 [13] 。 
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图 2-8 ”谷歌 TPU 控 制 器 


2.2.2 ” 智 鹏 汽车 党 用 传感器 


传感器 是 智能 汽车 区 别 于 传统 汽车 最 主要 的 表 观 特征 ， 也 占据 了 智能 汽车 成 本 增 量 的 主要 部 分 。 目 前 ， 智 能 汽车 常用 的 传感器 有 全 球 定位 系统 
(Global Positioning System，GPS) 、 惯 性 测量 单元 (IMU) 、 流 光 雷 达 、 毫 米 波 雷达 、 相 机 等 。 表 2-1 中 列 出 了 不 同 传感器 的 优点 与 缺 护 。 从 表 中 可 
见 ， 目 前 还 没有 一 种 传感器 能 够 完成 智能 汽车 的 所 有 感知 任务 ， 多 传感器 融合 技术 是 必然 的 选择 。 


表 2-1 智能 汽车 典型 传感器 的 优 缺点 
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1.GPS 


GPS 的 全 称 为 全 球 定位 系统 ， 在 智能 汽车 中 有 着 非常 重要 的 运用 。 它 能 提供 给 汽车 一 个 相对 准确 的 定位 ， 是 一 种 绝对 定位 方式 。GPS 在 全 球 的 覆盖 范 
围 广 ， 成 本 低 ， 且 不 受气 候 影响 。 全 球 定位 系统 除了 GPS 外 ， 还 有 欧洲 的 伽利略 卫星 导航 系统 、 俄 罗斯 的 格 洛 纳 斯 (GLONASS) 卫星 导航 系统 和 中 国 的 北 
斗 卫星 导航 系统 。 

GPS 包括 空间 部 分 、 地 面 控制 系统 和 用 户 设备 部 分 ( 即 GPS 接收 机 ) 三 部 分 。 用 户 通过 接收 GPS 卫星 发 出 的 无 线 电信 和 号， 测量 卫星 发 射 信 号 和 接收 机 
接收 到 信号 的 时 间 差 来 完成 距离 的 测量 ; 然后 利用 三 维 坐标 中 的 距离 公式 ， 通 过 三 颗 卫 星 来 构建 三 个 解 算 方程 ， 从 而 解 算出 位 置 坐标 (Xx，y，z) 完成 定位 
作用 。 理 论 上 利用 三 颗 卫星 就 可 以 实现 GPS 的 定位 功能 ， 但 在 实际 中 由 于 GPS 卫星 上 的 时 钟 和 接收 机 的 时 钟 存在 不 同步 导致 时 差 的 原因 ， 在 实际 定位 中 需 
要 引入 第 四 颗 卫 星 的 信号 完成 对 时 间 的 修正 ， 从 而 得 到 GPS 接收 机 的 准确 位 置 和 高 度 [4] 。 

由 于 民用 的 GPS 存 在 轨道 误差 、 时 钟 误差 、 大 气 影 响 误差 、 多 径 效应 以 及 其 他 误差 ， 因 此 GPS 的 定位 精度 只 能 达到 米 级 别 ， 这 样 的 定位 精度 不 足以 支 
撑 智 能 汽车 的 定位 需求 。 因 此 需要 利用 差分 定位 方式 来 提高 定位 精度 ， 精 度 可 以 达到 分 米 甚至 厘米 级 别 。 根 据 差分 GPS 基 准 站 发 送 的 信息 类 型 可 将 差分 
GPS 定位 分 为 三 类 ， 即 位 置 差分 、 伪 距 差分 和 相位 差分 【1?]」 。 该 方法 可 以 消除 大 部 分 的 误差 ， 但 不 能 消除 各 用 户 接收 机 固有 的 误差 ， 成 本 也 非常 高 。 可 
见 ， 仅 仅 采 用 GPS 无 法 满足 智能 汽车 的 定位 需求 ， 还 需 结合 其 他 的 技术 或 者 传感器 完成 对 车 辆 的 准确 定位 。 


2.IMU 


IMU 一 般 采 用 微机 电 系 统 构建 ， 典 型 的 IMU 包 含 三 个 加 速度 传感器 和 三 个 轴 陀 螺 ， 系 统 通过 解 算 空间 三 维 坐标 下 三 个 轴 的 加 速度 和 角速度 ， 来 测量 物 
体 在 各 个 轴 向 运动 的 距离 和 绕 各 轴 偏 转 的 角度 ， 从 而 获得 当前 的 系统 姿态 。 基 于 MEMS 的 IMU 一 般 采 用 微 电 子 和 微机 械 加 工 技术 制作 ， 与 传统 的 传感器 相 
比 ， 它 具有 体积 小 、 重 量 轻 、 成 本 低 、 功 耗 低 、 可 靠 性 高 等 特点 [16] ， 典 型 车 用 IMU 如 图 2-9 所 示 。 





Xsens 人 公司 MTI-10 系 全 IMU 


图 2-9 ”典型 车 用 IMU 产 品 


MEMS 加 速度 计 通 党 由 悬挂 系统 和 检测 系统 组 成 ， 通 过 测量 微 硅 块 的 偏 移 来 实现 对 加 速度 的 检测 ， 其 依据 是 牛顿 的 经 典 力学 定律 。 按 检测 方式， 加 速 
度 计 有 压 阻 式 、 电 容 式 、 隧 道 式 、 共 振 式 、 电 热 式 等 几 种 。 其 中 ， 电 容 式 加 速度 计 具 有 灵敏 度 高 、 噪 声 低 、 漂 移 小 、 结 构 简单 等 优点 1， 13] 。 其 中 可 偏 
移 的 电容 板 的 偏 移 量 和 加 速度 的 大 小 呈正 比 ， 从 而 可 以 通过 测量 相应 电容 大 小 的 变化 量 来 测量 加 速度 的 大 小 。 


把 加 速度 计 和 陛 螺 仪 结合 起 来 的 IMU 可 以 准确 、 快 速 地 测量 得 到 被 测 对 象 的 姿态 ， 且 不 受 外 界 环境 的 影响 ， 其 刷新 频率 可 高 达到 1kHz， 完 全 可 以 满足 
汽车 定位 实时 性 的 要 求 。 缺 点 在 于 其 定位 精度 随 痢 时间 的 推移 而 明显 下 降 ， 有 误差 累计 的 效果 。 由 于 GPS 和 |MU 两 者 的 特点 ，GPs 定 位 相对 准确 ， 但 是 其 
刷新 频率 低 ，IMU 刷 新 频率 高 ， 定 位 精度 随 着 时 间 的 推移 而 下 降 ， 通 过 把 两 者 结合 起 来 可 以 很 好 地 完成 对 车 辆 的 定位 。 卡 尔 曼 滤波 能 够 很 好 地 完成 对 这 两 
者 信号 的 融合 ，|IMU 为 车 辆 提供 较 高 频率 的 刷新 定位 ，GPS 在 其 刷新 周期 内 完成 对 IMU 误 差 的 修正 ， 从 而 满足 汽车 定位 实时 性 和 准确 性 的 要 求 。 


3. 激 光 雷 达 


激光 雷达 在 自动 驾驶 车 辆 中 有 着 非常 重要 的 作用 ， 它 可 以 大 范围 、 大 角度 、 高 精度 地 对 周围 环境 进行 扫 摘 ， 然 后 对 扫描 得 到 的 点 云 进行 处 理 ， 实 现 对 
3D 环 境 的 实时 建 模 。 激 光 备 达 人 在 车 辆 定位 、 对 象 识 别 、 对 象 退 踪 、 环 境 感知 和 高 精 地 图 的 创建 等 多 个 关键 技术 中 都 有 着 非常 重要 的 作用 。 


激光 雷达 的 工作 原理 和 普通 的 雷达 测 距 类 似 ， 只 是 其 发 射 的 激光 射线 波 远 远 低 于 传统 雷达 波 的 波长 ， 所 以 其 可 以 达到 很 高 的 测量 精度 。 它 向 被 测 物 体 
发 冉 一 束 激光 ， 通 过 测量 友 射 和 接收 的 时 间 间 隔 以 及 返回 激光 的 强度 ， 从 而 得 到 被 测 物 体 的 距离 d 和 物体 反 册 度 ， 然 后 经 过 推算 可 以 得 到 某 点 的 三 维 空间 坐 
标 ， 通 过 对 各 点 进行 扫描 即 可 形成 对 环境 的 建 模 。 其 坐标 解 算 示 意图 如 图 2-10 所 示 。 


z=d * sina 


> | yd， cosa + sinb 


X= * COSd * Cosbh 





图 2-10 ”激光 雷达 测量 原理 示意 图 


一 般 而 言 ， 激 光 雷 达 和 车 辆 刚性 连接 在 一 起 ， 其 垂直 的 角度 a 固定 不 变 。 因 此 ， 利 用 测量 得 到 的 扫描 距离 d 和 已 知 垂直 和 角度 a， 就 可 以 推算 出 被 测 点 的 Z 
轴 坐 标 及 其 在 XOY 平 面 内 的 投影 。 在 扫描 过 程 中 激光 雷达 还 会 记录 扫描 时 激光 束 的 水 平角 度 b， 通 过 这 个 角度 可 以 计算 出 被 测 点 的 X 轴 和 Y 轴 坐标 。 需 要 注 
意 的 是 ， 每 个 激光 传感器 安装 的 位 置 不 同 ， 光 束 的 水 平方 位 角 也 有 差异 ， 所 以 光束 并 不 在 同一 个 垂直 平面 内 。 因 此 ， 对 应 每 个 激光 器 ， 还 需要 采用 校准 标 
定 参数 ( 即 每 个 激光 束 的 位 置 和 方向 的 参数 ) ， 来 对 激光 雷达 进行 数据 校准 。 【3 


按 线 数 分 类 ， 激 光 雷 达 可 以 分 为 1 线 到 64 线 不 等 ， 不 同 的 线 数 感知 的 学 围 和 精度 不 一 样 ， 所 产生 的 点 云 以 及 相应 产生 的 计算 量 也 不 一 样 ， 常 用 的 有 64 
线 、32 线 、16 线 等 。 按 其 内 部 结构 ， 激 光 雷 达 可 分 为 机 械 式 、 固 态 式 和 两 者 相 混 合 的 混合 固态 式 。 机 械 式 是 其 内 部 族 转 部 件 为 机 械 式 ;固态 式 及 用 相 控 阵 
技术 ,利用 电子 设备 代 蔡 机 械 部 件 ， 其 体积 更 小 ， 方 便 集 成 在 车 身 内 部 ， 可 靠 性 高 ， 成 本 更 低 ， 是 未 来 激光 雷达 发 展 的 一 个 必然 方向 。 


在 智能 汽车 中 ， 最 常 使 用 的 是 Velodyne 公 司 生产 的 64 线 和 32 线 激光 雷达 。 另 外 具有 代表 性 的 激光 雷达 厂商 有 西 克 (SICK) 、 欧 百 拓 (IBEO) 和 
Quanergy 等 公司 。 西 克 的 一 维 激 光 雷 达 在 之 前 的 智能 汽车 上 应 用 得 非常 多 ， 其 典型 的 产品 型 号 为 SICK LMS511 一 维 激光 雷达 。 欧 百 拓 主 要 供应 4 线 和 8 线 
激光 雷达 ， 其 采用 固定 激光 光源 ， 通 过 内 部 玻璃 片 的 旋转 来 实现 激光 方向 的 改变 ， 由 于 缺乏 旋转 部 件 ， 所 以 其 水 平视 角 较 小 ， 需 要 配合 使 用 多 个 激光 雷达 
才能 完成 对 周围 环境 的 感知 。 [14 

激光 雷达 具有 较 多 优点 ， 但 仍然 面临 一 些 问题 和 挑战 。 一 方面 ， 其 工作 时 比较 容易 受到 天 气 的 影响 ， 在 晴朗 的 天 气 中 ， 激 光 的 衰减 很 小 ， 但 在 大 雨 、 
浓 雾 和 浓 烟 的 环境 中 ， 激 光 的 衰减 加 剧 ， 传 播 的 距离 大 受 影响 。 同 时 大 气 环流 还 会 使 激光 光束 发 生 畸 变 、 拌 动 ， 直 接 影响 激光 雷达 的 测量 精度 。 另 一 方 
面 ， 当 激光 雷达 遇 到 高 反射 率 的 表面 时 ， 其 测量 精度 也 会 受到 影响 。 一 般 物体 表面 都 有 一 定 的 粗糙 度 ， 激 光 雷 达 光 束 照 在 物体 表面 时 会 发 生 各 向 反射 ， 从 
而 能 够 接收 到 反射 回来 的 激光 信号 完成 测 距 。 然 而 ， 当 物体 表面 反射 率 过 高 时 ， 只 有 微弱 甚至 没有 反射 回来 的 激光 信和 号， 这 样 就 影响 了 对 高 反射 率 物体 的 
测量 。 另 外 ， 当 使 用 纯 机 械 式 激光 雷达 时 ， 其 扫描 旋转 频率 深 受 机 械 结构 的 限制 ， 最 快 的 旋转 速率 大 约 为 10Hz， 限 制 了 数据 流 的 刷新 频率 。 


4 毫米 波 雷达 


富 米 波 雷 达 在 智能 汽车 中 有 着 非常 重要 的 作用 ， 且 无 法 被 油光 雷达 、 相 机 等 其 他 传感器 所 取代 ， 它 能 够 准确 地 完成 对 距离 、 速 度 和 角度 的 测量 。 与 激 
世 


光 雷 达 相 比 ， 它 具有 了 明显 的 多 普 勒 效 应 ， 可 以 检测 其 多 普 勒 频 移 来 实现 对 移动 物体 速度 的 测量 ; 与 相机 相 比 其 能 够 提供 深度 信息 ， 可 以 直接 测 得 物体 的 距 
离 。 


写 米 波 实 质 上 是 电磁 波 ， 其 频率 高 于 无 线 电 ， 低 于 可 见 光 和 红外 线 ， 其 频率 泡 围 为 10GHz ~ 200GHz， 其 中 汽车 上 所 用 的 毫米 波 雷 达 频 段 有 24GHz、 
60GHz、77GHz、79GHz。 比 较 弟 用 的 是 24GHz 和 77GHz 频 段 的 富 米 波 雷 达 ，24GHz 毫 米 波 雷 达 主 要 用 于 短 距离 的 测量 ， 如 泊 车 辅助 、 盲 点 检测 以 及 辅 
助 变 道 等 。77GHz 毫 米 波 雷达 的 分 辨 率 、 测 速 和 测 距 的 精度 都 较为 优越 ， 主 要 用 于 前 方 障碍 物 的 距离 、 速 度 以 及 位 置 等 的 检测 。 


室 米 波 雷 达 最 基本 的 探测 扩 术 是 使 用 调频 连续 波 (FMCW) 技术 ， 友 射 机 首先 生成 一 个 频率 随时 间 线 性 变化 的 连续 小， 毫米 波 经 过 传播 到 达 目 标 后 返 
回 接收 天 线 ， 雷 达 接 收 的 目标 返回 波 与 发 射 机 的 信号 通过 混 频 器 三 加 奈 合 。 [<0] 由 于 在 无 线 电 波 的 传播 过 程 中 发 射 机 信号 频率 发 生变 化 ， 因 此 在 混 频 器 的 
输出 端 会 出 现 闫 频 信号 ， 差 频 信 号 和 时 延 呈 线性 关系 : 物体 越 远 时 延 越 大 ， 则 检测 到 的 帮 频 越 大 。 如 果 被 测 目标 是 运动 的 ， 那 么 反射 回来 的 电磁 波 频 率 附 
加 了 一 个 与 目标 运动 速度 呈正 比 的 多 普 勒 频率 。 该 磊 频 信号 中 即 包 含 了 目标 的 距离 和 目标 的 速度 等 相关 信息 ， 通 过 对 差 频 信号 的 解析 即 可 得 到 被 测 目标 的 
距离 和 速度 。 当 检测 静止 物体 时 ， 基 本 工作 原理 示意 图 如 图 2-11 所 示 。 
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图 2-11 FMCW 毫 米 波 雷达 静止 目标 测 焉 原理 示意 图 


其 中 距离 计算 的 公式 如 下 : 


ec» 
4AF- 


式 中 ，R 为 与 目标 的 距离 ，c 为 电磁 波 速 度 ，T 为 调制 三 角 波 的 周期 ，AF 为 调频 市 完 ，fo 为 友 射 信号 与 返回 信号 的 频 差 。 由 式 (2-1) 可 知 距离 和 频 差 呈 


R fh 1 


线性 关系 ， 在 调制 参数 T 与 AF 一 定 的 条 件 下 ， 测 得 频 差 fo 就 可 以 得 到 距离 [<1] 。 


室 米 波 雷 达 的 检测 距离 远 ， 能 够 检测 物体 的 速度 、 距 离 和 方位 ， 其 抗 天 气 干 扰 的 能 力 强 ， 价 格 便宜， 对 于 智能 汽车 有 看 非常 重要 的 意义 。 但 是 其 检测 
的 精度 不 如 激光 雷达 ， 且 不 能 检测 到 物体 具体 的 形状 。 


5. 相 机 


相机 是 一 种 能 够 获取 环境 图 像 信息 的 传感器 ， 也 是 智能 汽车 中 最 重要 的 传感器 之 一 。 相 机 获取 图 像 后 ， 将 光 信号 转化 为 图 像 模拟 信号 ， 并 传送 给 专用 
图 像 处 理 系统 ， 转 变 为 数字 化 信号 。 最 后 对 这 些 数字 信和 号 进行 运算 ， 以 抽取 目标 特征 ， 获 得 相应 的 识别 信息 。 【1] 特 斯 拉 Autopilot 系 统 是 相机 在 智能 汽车 
中 应 用 的 成 功 典 范 ， 该 系统 以 相机 为 主 传感器 ， 不 采用 激光 雷达 方案 ， 靠 相机 信息 进行 道路 识别 、 交 通 标志 识别 以 及 车 辆 和 行人 的 识别 等 ， 相 机 在 其 整体 
方案 构架 中 扮演 着 非常 重要 的 作用 。 相 机 按照 构成 形式 可 分 成 单 目 相 机 、 双 目 相机 和 全 景 相机 等 多 种 ; 按照 其 安装 在 汽车 上 的 位 置 可 以 分 成 前 视 相 机 、 后 
视 相 机 、 全 景 相机 以 及 车 内 监控 相机 等 。 

单 目 相机 一 般 安装 在 挡 风 玻 璃 的 上 部 ， 能 够 完成 对 目标 距离 和 运动 趋势 的 估计 。 单 目 视觉 可 以 根据 不 同 帧 图 像 ， 计 算 对 象 的 运动 轨迹 。 双 目 相机 也 称 
为 立体 相机 ， 使 用 两 套 光 学 成 像 系 统 ， 通 过 两 台 相机 对 同一 幅 场景 进行 拍摄 ， 来 估计 在 两 幅 图 像 中 对 应 像素 点 的 视差 ， 从 而 全 面 地 恢复 场景 的 深度 信息 ， 
感知 物体 的 位 置 和 大 小 。 [2<] 这 种 双 目 视觉 的 方法 不 需要 对 物体 进行 识别 ， 不 需要 大 量 的 训练 素材 库 ， 而 且 测 量 的 精度 和 可 靠 性 强 于 单 目 相 机 。 

全 景 相机 实际 上 是 由 多 个 相机 组 成 的 ， 这 些 相机 分 别 布置 在 汽车 的 不 同位 置 ， 一 般 安装 在 汽车 的 前 、 后 、 左 、 右 侧 ， 不 同 车 辆 的 全 景 相 机 的 数目 不 
同 ， 一 般 为 4~ 8 个 。 这 些 相 机 在 同一 时 间 内 对 环境 进行 成 像 ， 然 后 对 这 些 图 像 进行 矫正 和 拼接 ， 得 到 全 景 图 像 。 使 用 全 景 相机 能 够 快速 地 得 到 智能 汽车 四 
周 的 全 景 图 像 ， 可 以 进行 处 理 和 识别 。 多 相机 组 合 的 全 景 相机 因 其 获取 速度 快 、 信 息 丰富 全 面 、 像 素 高 、 镜 头 畸 变 小 、 各 个 方向 的 分 辨 率 近乎 一 致 等 优点 
而 被 广泛 应 用 。 上 3] 另外 ， 鱼 眼 相 机 由 于 能 够 实现 全 景 图 像 ， 无 须 进 行 图 像 拼接 ， 体 积 小 ， 价 格 低 ， 也 开始 受到 智能 汽车 行业 的 重视 。 


2.3” 吞 论 ; 气 车 的 软件 系统 构 染 


智能 汽车 是 一 个 庞大 而 复杂 的 系统 ， 在 进行 软件 系统 设计 时 ， 应 首先 搭建 软件 系统 构架 ， 然 后 根据 搭建 好 的 构架 依次 完成 各 部 分 的 设计 ， 最 终 完 成 整 


个 目 动 罗 驶 系统 的 开 友 。 图 2-12 为 典型 的 智能 汽车 软件 系统 构架 。 
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图 2-12 ”智能 汽车 软件 系统 构 染 


智能 汽车 软件 系统 主要 包括 主机 操作 系统 、 中 间 层 运行 框架 和 应 用 层 三 大 部 分 。 应 用 层 是 系统 的 各 个 功能 组 件 ， 包 括 感知 、 决 策 和 控制 三 个 大 的 方 
面 。 


2.3.1 主机 操作 系统 


目前 智能 汽车 常见 的 操作 系统 有 Linux、Windows 和 esOL 等 ， 各 种 操作 系统 具有 各 自 的 特点 。Linux 操 作 系统 具有 开发 效率 高 、 可 移植 性 好 、 资 源 开 
源 等 特点 ， 是 目前 智能 汽车 系统 开 友 的 主要 选择 。 


2.3.2 ”中 间 层 运行 框 染 


中 间 层 运行 框 染 是 智能 汽车 的 基础 平台 ， 它 能 够 为 系统 的 应 用 层 提供 灵活 的 模块 配置 ， 以 便 快速 地 增添 和 删除 功能 模块 。 同 时 它 应 具有 丰富 的 调试 工 
具 来 完成 算法 的 快速 调试 和 功能 的 验证 ， 提 高 整个 系统 的 开发 效率 ， 快 速 实现 算法 的 更 迭 ， 如 百度 的 阿波 罗 、 机 器 人 操作 系统 ROS 等 。 其 中 ，ROS 是 一 个 
分 布 式 、 基 于 消息 进程 的 运行 框架 ， 它 支持 利用 不 同 语言 、 不 同 功能 的 模块 分 开 单 独 设计 ， 再 利用 其 丰富 的 可 视 化 模块 以 及 相关 的 开源 算法 ， 快速 高 
效 地 完成 调试 。 当 需要 进行 整个 系统 调试 或 者 上 车 调试 时 ， 可 以 以 消息 接口 的 定义 完成 各 模块 的 集成 ， 名 古 屋 大 学 (Nagoya University) 的 Autoware 系 
统 就 是 及 用 ROS 作 为 实行 运行 框 染 的 。 


2.3.3 ”应 用 层 


应 用 层 是 系统 各 个 具体 功能 模块 的 实现 ， 具 体 的 功能 模块 根据 设计 的 需求 而 定 ， 每 个 具体 的 功能 模块 都 对 应 着 相应 的 应 用 程序 。 下 面 主 要 根据 系统 的 


感知 、 决 策 和 控制 三 个 层面 来 介绍 应 用 层 的 主要 功能 模块 。 
1. 感 知 层面 


感知 层面 主要 是 指 智 能 汽车 通过 传感器 实现 对 各 驶 环境 的 感知 理解 。 它 主要 包括 车 路 标识 线 跟踪 、 行 人 识别 与 定位 、 车 辆 识别 与 定位 、 交 通 标 志 理 
解 、 当 前 环境 危险 态势 评估 等 基础 模块 。 智 能 汽车 为 了 保证 环境 感知 系统 的 识别 准确 率 和 可 靠 性 ， 往 往 配备 多 个 传感器 ， 这 就 需要 智能 汽车 系统 能 够 实现 
多 传感器 信息 的 融合 。 智 能 汽车 的 多 传感器 融合 技术 的 研究 始 于 20 世 纪 80 年 代 ， 形 成 了 许多 方法 ， 单 用 的 方法 有 : 加 权 平 均 法 、 幢 叶 斯 估计 方法 、 卡 尔 曼 
滤波 、 模 糊 逻 辑 、 产 生 式 规 则 、 人 工 神经 网 络 等 “3] 。 例 如 ， 将 激光 雷达 和 相机 的 信息 相 融 合 可 以 实现 两 者 功能 上 的 互补 ， 获 得 障碍 物 的 形状 、 大 小 和 纹 
理 等 ， 实 现 对 行人 、 和 王 辆 等 更 加 准确 的 检测 。 利 用 多 传感器 融合 撤 术 还 可 以 降低 成 本 ， 采 用 精度 较 低 的 多 种 传感器 也 可 以 同样 达到 单一 局 精度 传感器 的 效 
果 。 


2. 决 策 层面 


决策 层面 主要 包括 行为 预测 和 路 径 规划 ， 行 为 预测 是 指 对 识别 追踪 对 象 的 行动 进行 预测 ， 根 据 预 测 的 结果 调整 相关 的 驾驶 策略 。 路 径 规 划 包 括 全 局 路 
径 规 划 和 局 部 路 径 规划 。 局 部 路 径 规划 主要 包括 汽车 轨迹 和 速度 的 规划 ， 在 选择 路 径 时 应 充分 考虑 车 辆 行驶 的 安全 性 、 平 顺 性 以 及 连续 性 等 因素 ， 同 时 还 
要 考虑 汽车 运动 的 约束 和 道路 条 件 的 约束 ， 从 而 选择 出 一 条 最 优 的 行驶 路 径 。 对 于 速度 规划 ， 首 先 应 考虑 当前 环境 对 于 和 车速 的 限制 ， 这 是 速度 规划 最 基本 
的 限制 。 另 外 由 于 过 大 的 侧 向 加 速度 会 影响 车 辆 的 稳定 性 和 对 路 径 的 跟踪 ， 所 以 最 大 侧 向 加 速度 对 于 车 速 的 限制 也 是 一 个 应 该 考虑 的 因素 。 对 于 保守 的 速 
度 规划 ， 一 般 通 过 生成 路 径 的 最 大 曲率 来 得 到 速度 的 限制 “4] 。 同 时 应 考虑 路 面 的 情况 对 车 辆 的 影响 ， 比 如 坡 道 、 斜 度 、 曲 率 等 ， 这 些 都 会 影响 车 辆 的 动 
力学 特性 。 因 此 在 路 径 规划 时 应 该 考虑 这 些 因素 的 影响 ， 这 样 才能 实现 对 于 车 辆 更 加 准确 有 效 的 控制 。 


3. 控 制 层 面 


控制 层面 依据 路 径 规 划 产 生 的 结果 生成 车 辆 控制 的 命令 ， 包 括 纵向 控制 、 横 向 控制 和 信号 灯光 系统 等 的 控制 ， 最 后 生成 的 命令 通过 汽车 总 线 上 太 送 给 各 
系统 的 电子 控制 单元 ， 完 成 对 车 辆 的 控制 。 为 了 保证 控制 的 精度 ， 通 单 把 车 辆 控制 后 的 测量 结果 和 期 待 的 运动 状态 结果 进行 比较 ， 这 样 的 控制 称 为 反馈 控 
制 。 最 有 名 的 反馈 控制 融 是 PID 控 制 ， 它 将 误差 分 为 比例 误差 、 积 分 误差 和 微分 误差 三 部 分 。PID 控 制 由 于 性 能 稳定 、 控 制 准确 ， 人 在 控制 领域 中 得 到 了 广泛 
的 应 用 。 但 是 由 于 它 并 不 是 基于 数学 模型 的 控制 ， 当 应 用 于 汽车 控制 这 种 非 线性 、 有 具有 大 惯性 和 时 延 的 系统 中 时 ， 其 控制 效果 不 理想 。 目 前 有 比较 多 的 控 
制 理 论 ， 如 神经 网 络 控制 、 基 于 模型 预测 的 控制 等 万 法 ， 都 可 以 很 好 地 完成 后 辆 的 控制 。 王 辆 的 控制 将 是 一 个 多 模型 、 多 控制 理论 耦合 的 控制 系统 ， 如 基 
于 车 联网 环境 下 的 智能 车 辆 协作 式 .控制 理论 和 万 法 。 


2.4 色 能 汽车 的 通信 系统 


智能 汽车 的 通信 系统 是 汽车 各 模块 、 汽 车 和 其 他 物体 之 间 信息 交流 的 关键 ,保证 信息 高 动态 、 低 延 时 的 交互 传送 ， 是 实现 智能 交通 系统 的 关键 技术 。 
按照 通信 在 汽车 上 所 履 善 的 学 围 可 以 将 通信 系统 分 成 后 内 通信 、 和 车 际 通 信和 广 域 通 信 。 和 车 内 通信 主要 包括 蓝牙 、WIFI、 以 太 网 通信 、 局 部 互联 协议 
(LIN) 、CAN 通 信 、 高 速 容错 网 络 协 议 (FlexRay) 等 ， 主 要 实现 人 机 交互 和 对 车辆 的 控制 。 车 际 通信 主要 存在 专用 短程 通信 技术 (DSRC) 和 长 期 演进 
技术 (TLE-V) 两 种 ， 前 者 发 展 的 历史 较 长 ， 其 技术 比较 成 熟 ， 后 者 主要 是 面向 智能 交通 和 和 车 联网 的 应 用 。 广 域 通信 和 是 利用 现 有 的 移动 互联 网 领域 的 3G、 
4G 以 及 未 来 的 5G 等 通信 技术 ， 实 现 车 辆 和 周边 环境 、 控 制 中 心 以 及 云端 等 大 学 围 的 通信 ， 从 而 使 智能 汽车 更 好 地 获得 实时 路 况 、 道 路 信息 和 行人 信息 等 一 
系列 交通 信息 ， 做 出 更 好 的 驾驶 决策 。 


2.4.1 智能 汽车 车 内 通信 


在 车 内 通信 中 ，LIN、CAN 和 FlexRay 主 要 是 用 于 汽车 各 系统 电子 控制 单元 之 间 的 通信 ， 和 车 内 通信 和 网络 对 于 智能 汽车 的 控制 十 分 重要 。 智 能 汽车 在 经 过 
感知 、 决 策 之 后 生成 的 控制 指令 ， 最 终 都 要 通过 车 内 的 总 线 网 络 发 送 到 各 ECU 上 ， 完 成 对 各 系统 的 控制 。 目 前 ， 某 些 跨 界 高 科技 公司 正 涉足 智能 汽车 领 
域 , 但 在 思 线 控制 方面 ， 传 统 车 企 不 会 对 它们 开放 车辆 思 线 协议 ， 它 们 不 得 不 和 和 车厂 合作 ， 完 成 智能 汽车 系统 和 汽车 控制 忌 线 的 对 接 。 可 见 ， 即 使 智能 汽 
车 有 相当 高 的 智能 程度 ，LIN 和 CAN 忆 线 技术 仍然 有 着 十 分 重要 的 应 用 ， 同 时 更 加 高 级 的 通信 协议 如 MOST、FlexRay 等 也 逐渐 出 现在 汽车 上 ， 它 们 能 够 为 
通信 提供 更 高 的 速率 和 可 靠 性 ， 代 表 着 车 内 总 线 通信 未 来 友 展 的 一 个 方向 。 


LIN 总 线 是 一 种 低 成 本 、 低 速率 的 串 行 通信 和 网络， 其 位 传输 速率 一 般 不 超过 20Kb/s， 适 用 于 对 容错 性 能 、 传 输 速 率 要 求 不 高 的 场合 ， 主 要 用 于 汽车 上 
的 电动 门窗 、 雨 刮 器 以 及 照明 系统 等 。 它 采取 一 主 多 从 的 模式 ， 即 一 个 主 控 制 器 上 连接 了 若干 个 从 属 节 上 后， 其 节操 数 最 多 可 以 达到 12 个 。 通 信息 是 从 主 控 


制 器 发 起 ， 其 发 出 的 任务 可 以 同时 被 多 个 节点 接收 ， 节 点 在 接收 任务 后 通过 解析 、 判 断 决定 其 是 否 执行 相应 的 任务 。 在 整 车 网 络 中 ， 各 LIN 网 络 的 主 控制 器 
利用 CAN 模 块 接 入 CAN 总 线 网 络 ， 从 而 成 为 整 车 通信 网络 的 一 个 子 网 ， 实 现 对 CAN 总 线 的 扩展 和 补充 ， 这 样 的 设计 既 实现 了 不 同 速 率 的 网 络 分 级 ， 优 化 网 
络 结构 ， 也 节约 了 整 车 成 本 。 [2?] 


CAN 忆 线 通 信 是 车 载 网 络 最 主要 的 通信 方式 ， 由 德国 博世 公司 在 20 世 纪 80 年 代 提 出 ， 目 前 已 经 成 为 行业 的 通用 标准 ， 车 辆 通过 CAN 通 信和 完成 各 系统 的 
ECU 之 间 的 数据 交换 。CAN 的 通信 协议 在 经 过 |SO 标 准 化 之 后 有 两 个 标准 : 针对 125Kb/s ~ 1Mb/s 的 通信 速率 的 高 速 CAN 网 络 通 信 标 准 和 低 于 125Kb/s 的 
通信 速率 的 低速 CAN 网 络 通信 标准 。 对 于 通信 实时 性 要 求 较 高 的 部 分 一 般 使 用 高 速 CAN 网 络 传 输 ， 如 友 动 机 控制 单元 、 转 向 系统 控制 单元 等 。 对 于 通信 实 
时 性 要 求 较 低 的 部 分 一 般 使 用 低速 CAN 网 络 传输 ， 如 车 门 、 照 明 系 统 以 及 温度 控制 等 。 图 2-13 为 典型 智能 汽车 车 载 舒 适 系统 CAN-LIN 总 线 网 络 拓扑 图 。 


全 无 钥匙 进入 系统 ”报警 与 锁 止 系统 
< ( PKE ) ( Warning and Locking ) 


( Starter ) 





全 数 子 组合 仪 表 | 防盗 与 局 动 系统 
( Anti Thief ) 


系统 


高 速 CAN | 中 有 速 CAN 
驾驶 员 侧 组 合 开 关 转 CDDB ) 
( DDSP ) 车 窗 刑 











硬 线 (Window Lift ) 
外 部 照明 系统 
(Exterior Lighting ) 


后 视 镜 等 其 他 系统 十 刊 系统 内 部 照明 系统 
(Rear Mirror ) ( Wiper Sistem ) ( Interior Lamp ) 


图 2-13 ”典型 智能 汽车 车 载 舒 适 系统 CAN-LIN 总 线 网 络 拓扑 图 


CAN 总 线 由 CAN_H 和 CAN _L 两 根 线 组 成 ， 采 用 双 绞 线形 式 可 以 抵抗 电磁 干扰 。CAN 控 制 器 通过 这 两 根 线 上 的 电位 差 来 确定 总 线 的 电 平 ， 即 隐形 电 平 
和 显 性 电 平 。CAN 总 线 与 一 般 的 通信 总 线 相 比 ， 具 有 较 高 的 可 靠 性 、 实 时 性 和 灵活 性 ， 其 特点 可 以 概括 如 下 : 

(1) CAN 总 线 是 一 种 面向 内 容 的 编 址 方式 ， 其 相关 的 控制 单元 通过 CAN 总 线 挂 在 整个 通信 和 网络 上 ， 增 减 单元 不 会 影响 其 他 单元 ， 这 样 增加 了 系统 的 
灵活 性 ， 可 以 更 加 容易 地 实现 对 整个 系统 的 配置 。 

(2) CAN 总 线 采 用 多 主 节点 架构 ， 当 总 线 空闲 时 ， 连 接 在 总 线 上 的 所 有 单元 都 可 以 启动 发 送信 息 ， 当 多 个 单元 同时 发 送 消息 时 便 通 过 相应 的 仲裁 机 
制 根据 各 单元 的 1D 决 定 优先 级 ， 优 先 级 高 的 单元 获得 发 送 数据 的 权利 。 

(3) CAN 总 线 以 广播 的 方式 发 送 数 据 。 当 一 个 单元 发 送 数据 时 ， 该 单元 的 CPU 把 将 要 发 送 的 数据 和 标识 符 发 送 给 本 单元 的 CAN 芯 片 ， 并 使 其 进入 准 
备 状 态 ; 一 旦 该 CAN 芯 片 收 到 总 线 的 分 配 ， 就 变 为 发 送 报 文 的 状态 ， 该 CAN 芯 片 将 要 发 送 的 数据 组 成 规定 的 报 文 格式 发 出 。 此 时 ， 网 络 中 的 其 他 节点 都 处 
于 接收 状态 ， 所 有 节点 都 要 先 对 其 进行 接收 ， 通 过 检测 来 判断 该 报 文 是 不 是 发 给 自己 的 。 

(4) CAN 总 线 还 有 错误 检测 、 通 知 和 恢复 功能 。 所 有 单元 均 可 以 检测 出 错误 ， 检 测 到 错误 的 单元 立刻 同时 通知 其 他 所 有 单元 。 如 果 一 个 单元 发 送信 
息 时 检测 到 一 个 错误 ， 它 会 强制 终止 信息 传输 ， 并 通知 其 他 所 有 单元 发 生 了 错误 ， 然 后 它 会 重新 发 送 ， 直 到 信息 正常 传输 出 去 。CAN 节 点 在 错误 严重 的 情 
况 下 ， 可 以 自动 关闭 输出 功能 ， 以 使 总 线 上 其 他 节点 的 操作 不 受 影响 。 [26] 


但 由 于 总 线 上 每 次 只 允许 一 个 单元 发 送 数据 ， 所 以 它 并 不 是 一 种 实时 性 的 总 线 ， 有 一 定 的 时 延 ， 当 上 面 的 节点 过 多 时 ， 其 通信 效率 和 速度 都 会 降低 。 


2.4.2 ”智能 汽 后 与 V2X 撤 术 


智能 汽车 属于 自主 式 智 能 汽车 ， 而 采用 V2X (Vehicle to Everything) 通信 技术 的 汽车 属于 网 联 汽 车 范畴 ， 两 者 的 结合 构成 了 智能 网 联 汽车 的 全 部 内 
涵 。 未 来 ， 智 能 汽车 除了 利用 自身 搭载 的 传感器 来 对 环境 进行 识别 外 ， 还 可 以 利用 通信 技术 实现 车 车 通信 和 车 路 通信 ， 进 而 实现 信息 的 实时 交互 与 共享 。 
图 2-14 为 采用 BDI (Belief-Desire-lntention) 分 层 交 互 协作 模型 构建 的 多 车 通信 协作 框架 图 。 
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图 2-14 基于 BDI 的 多 车 通信 协作 框架 图 


采用 V2X 技 术 ， 一 方面 ， 智 能 汽车 可 以 利用 车 车 信息 、 车 路 信息 更 好 地 感知 环境 ， 拓 宽 视 野 ， 做 出 更 加 正确 的 决策 和 控制 ， 另 一 方面 ， 智 能 车 辆 可 以 
更 好 地 融入 交通 系统 ， 实 现 交 通 的 智能 调度 和 协调 ， 进 而 提高 整个 交通 系统 的 运行 效率 。 下 面 将 介绍 V2X 中 两 种 关键 的 通信 技术 一 一 DSRC 和 TLE-V。 


1.DSRC 


DSRC 即 专用 短程 通信 技术 ， 是 一 种 专门 用 于 V2V 和 V2| 实 现 信息 双向 传输 的 无 线 通信 机 制 ““]】 ， 可 以 实时 传输 语音 、 图 像 和 数据 等 信息 。DSRC 系 统 
包括 专用 短程 通信 协议 、 路 侧 单 元 (Road Side Unit，RSU) 、 车 载 单 元 (On Board Unit，OBU) 三 部 分 ， 其 技术 和 产业 水 平 以 及 标准 化 水 平局 。 该 通 
言 技 术 开 始 于 20 世 纪 90 年 代 ， 在 美国 、 欧 洲 、 日 本 等 多 个 国家 级 项 目 中 得 到 应 用 ， 如 美国 Intelligent Drive 项 目 、 欧 洲 CVIS (Cooperative Vehicle 
Infrastructure Systems) 项 目 、 日 本 Smart Way 计划 等 [<8] 。DSRC 工 作 频 段 主 要 是 5.9GHz， 基 于 |EEE 802.11p 和 IEEE 1609 协 议 ， 主 要 包括 应 用 层 、 
介质 访问 控制 (MAC) 层 和 物理 层 ， 如 图 2-15 所 示 。 


[EEE 1609 系 列 标准 
IEEE 1609 .1 
[EEE 1609 .2 
[EEE 1609.3 
IEEE 1609.4 






美国 
DSRC 标 淮 


IEEE 802.11p 标 准 





图 2-15 DSRC 美 国标 准 


DSRC 的 传输 速率 高 、 时 延 小 ， 通 信 范 围 可 达 百 米 左右 ， 具 有 完美 的 加 密 通信 和 高 效 的 数据 传输 机 制 ， 能 够 满足 V2V 和 V21 的 数据 传输 要 求 与 实时 性 要 
求 。DSRC 具 有 广泛 的 应 用 领域 ,包括 不 停车 收费 、 出 入 控制 、 和 车 队 管 理 、 和 车 辆 识别 和 信息 服务 等 ， 这 些 都 已 经 在 交通 系统 中 得 到 应 用 ， 并 取得 了 不 错 的 效 
。 然 面 ， 它 也 存在 明显 的 不 足 忆 处， 在 用 户 数 较 多 时 ， 系 统 容量 急剧 下 降 ， 最 大 传输 时 延 和 可 靠 性 不 可 控 。 另 外 ， 它 对 于 基础 设施 和 道路 铺设 的 投入 
大 ， 难 以 实现 大 规模 商业 化 推广 ， 且 DSRC 主 要 针对 道路 履 兰 ， 难 以 满足 笠 在 离开 道路 乙 后 对 于 相关 服务 的 获取 。 


站 


2.LTE-V 


LTE-V 技 术 被 认为 是 实现 车 联网 的 重要 基石 ， 受 到 智能 交通 领域 人 士 的 看 重 。 基 于 4G 网 络 的 LTE 和 车 辆 通信 系统 ， 在 未 来 可 以 平滑 演进 到 5G。LTE-V 系 
统 包括 两 种 工作 模式 一 一 集中 式 (LTE-V-Cell) 和 分 布 式 (LTE-V-Direct) ， 前 者 通过 蜂 襄 通路 (Uu) 空中 接口 ， 借 助 于 已 有 的 蜂 贸 网 络 ， 实 现 大 市 宽 、 


大 履 关 的 通信 后 者 直接 通过 直 连 链 路 (PC5) 空中 接口 ， 实 现 车 辆 与 周边 环境 节点 低 时 延 、 高 可 靠 性 的 通信 。 其 中 Uu 空 中 接口 是 在 LTE 的 Uu 接 口 基础 上 
进行 了 针对 性 的 增强 ， 优 化 了 LTE 广 播 扩 术 ， 对 控制 信道 进行 裁剪 ， 进 一 步 降低 延迟 。PC5 空 中 接口 是 在 LTE-D2D (Device to Device) 的 基础 上 进行 了 多 


方面 的 增强 设计 ， 从 而 支持 车 辆 之 间 的 动态 信息 (例如 位 置 、 速 度 、 行 驶 方向 等 ) 的 快速 交换 和 高 效 的 无 线 资源 分 配 机 制 [3] ， 其 工作 模式 如 图 2-16 所 


个 \。 


-一 一 蜂 寡 通路 (Unu) 
一 直 连 链 由 (PC5 ) 





图 2-16 LIE-V 的 两 种 工作 模式 


LTE-V 以 现 有 的 蜂 视 网 络 作 为 V2X 的 基础 ， 直 接 利 用 现 有 的 基站 和 频段 ， 不 需要 铺设 专用 的 路 侧 通 信 设 备 ， 极 大 地 降低 了 成 本 ， 能 够 方便 地 实现 大 规模 
的 商业 化 推广 。 同 时 可 以 通过 基站 的 介入 来 协调 资源 的 分 配 ， 抗 干扰 能 力 大 大 提高 ， 具 有 更 高 的 安全 可 靠 性 ， 尤 其 是 在 车 辆 密集 的 场景 中 具有 了 明显 的 优 
势 。 B0] 另外 LTE V2X 在 设计 的 时 候 充 分 借鉴 了 DSRC 的 经 验 和 不 足 ， 在 系统 容量 、 覆 盖 范 围 等 方面 具有 显著 的 性 能 优势 。 这 两 种 技术 的 比较 如 表 2-2 所 


个 \。 


表 2-2 DSRC 与 LTE-V 性 能 对 比 


技术 路 线 办 


文 持 相 速 200km/h; 有 反应 时 间 黎 兽 泄 围 小 ; 数据 的 
100ms; 市 需 75MHz; 数据 的 传输 传输 速率 低 ， 于 包 率 
DSRC | 速率 最 低 12Mb/s， 最 高 27Mbys; 支 术 已 经 趋 导 高 ， 难 以 快速 处 理 大 量 
低 时 延 达到 20ms; 传 精 距离 为 几 允 据 ; 需要 大 量 建设 里 
百 米 昌 甸 被 建筑 物 阻挡 测 设备 ， 成 本 高 


去 坪 夺 速 500km/h; 吊 寺 可 扩 妆 洛 成 本 人 R; 1 四 了 
展 至 100MHz; 数据 的 传输 速 某 上 | 围 厂 ; a we 襄 


LTE-V | 行 S00Mbys， 正 行 1Cbys， 用 户 面 | 带 下 站 和 EE 研发 测试 阶段 
时 延 小 于 10ms， 控 制 面 时 延 小 于 | 低 ， 可 出 再 和 的 4C 图 
50ms; 传输 范围 广 ， 类 似 4G 网 络 | 络 基站 平滑 过 渡 到 SG 





LTE-V 有 着 十 分 光明 的 前 景 ， 其 只 需要 在 现 有 蜂 贸 网 络 上 进行 简单 、 局 部 的 升级 融 可 以 实现 应 用 ， 其 应 用 难度 低 ， 比 较 容易 成 功 推广 ;在 应 用 学 围 
上 ，LTE-V 具 有 范围 广 、 低 时 延 、 实 时 性 强 的 特点 ， 非 单 符合 后 联网 通信 的 要 求 ; 在 产业 链 上 ，LTE-V 有 华为 、 大 唐 以 及 高 通 等 通信 巨头 和 运营 商 作为 推动 
者 ， 相 比 DSRC 在 国内 更 具有 影响 力 ， 将 吸引 更 多 的 车 企 、 心 片 制 造 商 以 及 通信 设备 制造 商 等 加 入 进来 ， 另 外 国家 也 将 倾向 于 该 车 联网 通信 技术 ， 正 在 积极 
筹备 出 台 相 天 的 规范 ， 将 其 作为 一 种 顶层 设计 ， 来 推动 车 联网 通信 的 友 展 ， 从 而 为 智能 网 联 汽 车 的 友 展 打下 坚实 的 基础 ， 在 上 自主 知识 产权 上 ，LTE-V 是 中 
国 主导 的 车 联网 技术 ， 可 以 保证 技术 掌握 在 自己 的 手 里 ， 国 内 企业 可 以 规避 专利 风险 ， 有 利于 实现 车 联网 技术 的 这 道 超车 。 
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第 3 草 ”智能 汽车 环境 感知 拉 术 


系统 一 样 ， 是 智能 汽车 后 续 决策 与 控制 的 信息 来 源 。 目 前 ， 在 智能 汽车 环境 感 


智能 汽车 环境 感知 系统 束 像 人 类 的 “眼睛” “和 耳 米 ” 和 “鼻子 ”等 感官 
论 这 两 种 技术 在 智能 汽车 中 的 应 用 。 


知 系统 中 最 为 常见 的 仍 是 机 器 视 完 与 激光 雷达 技术 ， 本 章 也 将 重点 讨 


3.1 ”相机 模型 与 李 群 和 李 代 数 基 础 


在 智能 汽车 环境 感知 系统 中 ， 机 器 视觉 是 最 重要 的 传 感 手段 之 一 ， 正 确 理 解 相机 模型 对 理解 基于 视觉 的 环境 感知 系统 具有 重要 的 意义 。 


3.1.1 ”相机 坐标 系 的 定义 
从 机 器 视觉 成 像 的 几何 角度 来 看 ， 相 机 成 像 主要 涉及 四 个 坐标 系 : 世界 坐标 系 、 相 机 坐标 系 、 图 像 坐标 系 、 像 素 坐 标 系 。 各 个 坐标 系 之 间 的 关系 如 图 
3-1 所 示 。 


在 图 3-1 中 ，O-XYZ 坐 标 系 代 表 世 界 坐 标 系 ， 单 位 为 米 ; Oc-XcYcZc 坐 标 系 为 相机 坐标 系 ， 单 位 为 米 ; oxy 坐 标 系 为 图 像 坐标 系 ， 光 心 为 原点 ， 单 位 为 
室 米 ; uv 坐标 系 为 像素 坐标 系 ， 原 点 为 图 像 左 上 角 ， 单 位 为 像素 (Pixel) 。 





图 3-1 基本 坐标 系 


3.1.2 ”欧式 空间 坐标 转换 


1. 世 界 坐标 系 一 相机 坐标 系 


如 图 3-2a 所 示 ， 从 世界 坐标 系 转化 到 相机 坐标 系 主 要 涉及 旋转 和 平移 ， 属 于 刚体 变换 ， 而 相机 外 参数 瓯 代表 相机 在 世界 坐标 系 中 的 参数 ， 总 共 为 7 
个 ， 分 别 为 旋转 参数 和 位 置 平移 参数 。 三 维 坐标 系 下 x、y、z 轴 的 旋转 参数 分 别 为 (w，@，6) ， 于 是 可 以 得 到 对 应 轴 旋 转 信 息 的 3x3 起 阵 R1、R2、Ra， 


从 而 得 到 旋转 矩阵 R。 平 移 参数 为 (Tx、Ty、Tz) ， 得 到 平移 起 阵 T。 





a ) 世界 坐标 系 一 相机 坐标 系 图 b ) 坐标 系 绕 z 轴 旋 转 0 角 上 度 


图 3-2 


如 图 3-2b 中 ，xyz 坐 标 系 绕 z 轴 旋转 9 角度 ， 变 为 xQyozo 坐 标 系 ， 于 是 得 到 xyz 与 Xoyoz0 之 间 的 关系 式 (3-1) : 


x Cos 一 SInO 0 To | Xo 
yl=|sing cos0 0|*|%|= RY (3=1) 


同 理 可 以 得 到 绕 x 轴 和 绕 y 轴 的 旋转 矩阵 分 别 为 : 


| U U 

人 =|10 cosw sinw (3-2) 
U 一 SInw cosw 
| cos0 0 一 SIno| 

Ra =| 0 | U C3-3) 


siInDS 0 COSD 


那么 可 以 得 到 旋转 息 阵 R: 


R=R1R2R3 (3-4) 


同时 加 入 平移 矩阵 T， 世 界 坐 标 系 的 一 点 Q_ (X,Y，Z) 与 相机 坐标 系 下 Qc (Xc，Yc，Zc) 之 间 的 对 应 关系 为 : 
A [Ace] 
7 hm 央 yc 

Z | 交 

| | 


2. 相 机 坐标 系 一 图 像 坐标 系 


从 相机 坐标 系 到 图 像 坐 标 系 属于 投影 关系 ， 从 三 维 转换 为 二 维 。 


和 





图 3-3 ”相机 坐标 系 一 图 像 坐 标 系 


如 图 3-3 所 示 , 假设 (x，y) 为 p 点 在 图 像 上 的 坐标 ， (X,Y，Z) 为 空间 点 P 在 相机 坐标 系 下 的 坐标 ，f 为 oxy 平 面 与 图 像 平 面 的 距离 ， 一 般 称 为 摄像 
机 的 焦距 。 根 据 相 似 三 角形 原理 ， 可 以 用 齐 次 坐标 和 矩阵 表示 上 述 透 视 投 影 天 系 ， 于 是 得 到 关系 式 (3-6) : 


x 1 0 OrA 


0 (3=6) 


0 J 
| 0 0 1 二 2Z 
3. 图 像 坐 标 系 一 像素 坐标 系 


图 像 坐 标 系 与 像素 坐标 系 实际 上 都 处 于 成 像 平 面 之 上 ， 它 们 之 间 的 区 别 在 于 原点 和 度量 衡 的 不 同 。 


假设 某 一 点 在 像素 坐标 系 上 的 坐标 为 (u，v) ， 图 像 坐标 系 原点 o 在 像素 坐标 系 上 的 坐标 为 (ug，vo) 。 可 以 得 到 ， 点 p 在 图 像 坐 标 系 oxy 上 的 坐标 为 
(X，y) ， 于 是 得 到 (u，v) 和 (x，y) 的 关系 式 (3-7) : 


U wu, 
1 dx 
= 3-] 
] 0 | 。 | ( ) 


通过 上 述 四 个 坐标 系 的 转换 融 可 以 得 到 点 P 从 世界 坐标 系 的 坐标 (X，Y，Z) 转换 到 相机 坐标 系 的 坐标 (XC，YC，ZC) ， 进 而 转换 到 图 像 坐标 系 坐 标 


(x，y，z) ， 最 后 转化 为 像素 坐标 系 的 坐标 (uU，Vv) 的 路 径 ， 综 合式 (3-4) 至 式 (3-7) 得 到 点 P (X,Y，Z) 转换 到 相机 图 像 上 坐标 (u，v) 的 关系 如 


下 : 
() X 
u 上 | f/f 0 0 0 | | 
EE EF | oe 
Boys| 1 0 4700l | 
0 到 号 于 中 次 
| 0 0 1 0 
0 0 1 
jf, 0 wu, 0 
0 / 0 也 | | (3-8) 
二 7 4 
I 0 1JIZ 
0 0 1 0 
sd a 
在 式 (3-8) 中 ， ”下 "由 ，f 为 u 轴 上 的 尺度 因子 ， 或 称 为 u 轴 上 归 一 化 焦距 ;人 为 v 轴 上 的 尺度 因子 ， 或 称 为 v 轴 上 归 一 化 焦距 ， 得 到 相机 内 
0 pl | 相机 外 湖 数 和 兴隆 L011， 


3.1.3 ” 李 群 和 李 代 数 基础 

前 面 已 经 讲 过 基于 欧式 空间 的 坐标 系 变换 ， 但 在 更 多 时 候 ， 李 群 和 李 代数 应 用 得 更 加 广泛 深入 。 在 相机 的 位 姿 估计 中 ，SO (3) 和 SE (3) 尤为 重要 ，。 
考虑 到 读者 不 了 解 李 群 和 李 代数 的 基本 知识 ， 本 节 中 将 介绍 李 群 和 李 代 数 的 一 些 基 本 知识 。 如 果 读 者 想 要 详细 理解 李 群 和 李 代数 的 理论 ， 可 以 参考 天 于 李 
群 和 李 代 数 的 教材 。 
1. 李 群 与 李 代 数 的 定义 

李 群 (Lie Group) 是 指 具有 连续 (光滑 ) 性 质 的 群 ( 群 论 请 参考 教材 ) 。 像 整数 群 Z 是 离散 的 ， 因 此 不 具备 连续 性 ， 也 融 不 是 李 群 。 类 似 相机 的 刚体 
能 够 在 空间 当中 连续 运动 ， 所 以 是 李 群 。 

李 群 和 李 代数 有 对 应 的 关系 ， 每 个 李 群 都 有 相对 应 的 李 代 数 ， 李 代数 摘 述 了 李 群 的 某 泽 性 质 。 


李 代数 的 定义 为 : 令 V 是 数 城 F 一 个 同 量 空间 ， 各 V 上 有 一 个 运算 和 为 VxV 一 V: (Xx，y) 一 (Xx，y) ， 若 满足 以 下 条 件 则 称 V 为 李 代 数 。 


(1) 双 线 性 : (ax+By，nz+Yyw) =an (x, z) +oay (X，w) +Bn (y, z) +By (y，w) 。 


(2) 反对 称 性 : (x, y) [=- (y，x) 。 


(3) 满足 雅 可 比 (Jacobian) 恒等式 : (X， (yz) ) + (y，(z，X) ) + (Z， (X，y) ) =0，YX，y，z。 


2. 三 维 旋转 群 SO (3) 与 对 应 的 李 代 数 so (3) 


特殊 正 交 群 SO (n) 又 称 为 旋转 矩阵 群 ， 三 维 旋转 群 SO (3) 是 SO (n) 在 三 维 空间 上 ( 即 n=3) 的 特例 ，SO (n) 与 SO (3) 正式 的 记 法 为 


| 
es 


Pa = IR eR"™|RR' = 1,det(R)=1| ko 


SO0(3) = IREeR” |RR = 1,det(R) 


在 式 (3-9) 中 SO (3) 的 定义 有 RR =1， 现 在 考虑 它 随时 间 t 发 生变 化 ， 即 从 R 变 成 了 R_(t) ， 于 是 有 : R(t) R(t) “=1， 对 等 式 两 边 进行 求 导 便 可 


以 得 到 : 
RD)RCiD)T+RRCD)RCD)T =0 


RORG) =- (RGRG)') (3-10) 


从 式 (3-10) 中 可 以 看 出 ， 该 等 式 满足 反对 称 矩 阵 的 性 质 ， 是 一 个 反对 称 和 矩阵 。 注 意 到 对 于 任意 一 个 3x 3 的 反对 称 和 矩阵 A， 都 有 A = -A， 因 此 它 的 主 
对 角 线 元 素 必 为 0， 同 时 非 对 角 线 元 素 只 有 三 个 自由 度 。 我 们 可 以 把 它 对 应 到 一 个 向 量 a= (a1，a2，a3) 中 去 ， 如 下 : 


0 一 a 版 
| 全 0 -a, (3-11 ) 
0 a () 


其 中 ，^ 符 号 表示 由 向 量 转换 为 矩阵 ， 反 之 ， 我 们 也 可 以 用 符号 v 定 义 由 和 矩阵 转换 为 向 量 : a=A“。 因 此 肯定 存在 一 个 三 维 向 量 w (t) ， 使 得 该 向 量 组 


成 的 反对 称 和 矩阵 满足 : 
mw(1) = RO)RG) (3-12) 
| () (3 0 | 
WW = | ww; 0 一 I (3-13) 
一 CO Li 0 
式 (3-12) 可 以 写成 : 
R(1) = w (1)" R(L) (3-14) 


可 以 看 出 ， 每 对 旋转 和 矩阵 求 一 次 导数 ， 只 需 在 等 式 左 边 乘 一 个 w 和 矩阵 即 可 ，w 是 对 应 到 SO (3) 上 的 李 代 数 so (3) ; 这 就 将 上 式 与 微 积 分 中 的 指数 
( 即 一 个 变量 的 导数 等 于 它 本 身 再 乘 以 一 个 系数 ) 联合 起 来 。 由 于 WwW 反映 了 R 的 导数 性 质 ， 故 称 它 在 SO (3) 的 正切 空间 (Tangent Space) 上 。 对 上 面 公 


式 求 微分 方程 ， 同 时 设 初始 时 刻 为 to=0， 可 得 到 |: 


R (t) =exp [o (t) 和] (3-15) 





人 (ww 
> CA )( ) 下 } 、 \‖ cm) 一 一 二 | 一 \ Pm 
将 exp [w (t) ^] 按 泰 勒 公式 展开 可 以 得 到 |: i 名 n! ; 由 于 w 是 三 维 向 量 ， 我 们 可 以 定义 它 的 模 长 和 方向 ， 分 别 记 作 6 和 a， 那 么 按照 


上 式 可 以 推出 : 


i ,A Va"a’ 

explow ) -pla } = 六 i = +b + 1 
yaa’a” Oa’a’'a’a’ z 
i (3-16) 


J 安 


由 于 a 为 反对 称 矩 阵 ， 因 此 有 : aaI=a^a^+ | | a | | “3x3， 由 于 a 是 w 的 方向 向 量 ， 为 单位 向 量 ， 于 是 可 以 得 到 : aaI=a^a^+1，a^a^a^=-a^; 将 
这 两 个 式 子 带 入 式 (3-16) 中 可 以 得 到 如 下 式 子 : 

R=exp (6a 人 ) =cos6I+ (1 一 cos6) aaT 一 sin6a 人 人 (3-17) 

这 样 束 将 so (3) 的 旋转 向 量 通 过 指数 映射 到 了 一 个 位 于 SO (3) 中 的 3D 旋 转 。 如 果 定 义 对 数 映 射 ， 我 们 也 能 把 3O (3) 中 的 元 素 对 应 到 so (3) 中 ， 
如 下 所 示 : 

o=lnRY (3-18) 

需要 注意 的 是 ， 每 个 SO (3) 中 的 元 素 ， 都 可 以 在 so (3) 中 至 少 找到 一 个 元 素 与 之 对 应 ; 但 是 可 能 存在 多 个 so (3) 中 的 元 素 ， 对 应 到 同一 个 
SO (3) 元 素 上 ， 比 如 对 于 旋转 角 9， 它 具有 周期 性 。 


3. 特 殊 欧式 群 SE (3) 以 及 对 应 的 李 代数 se (3) 


从 前 面 欧式 空间 众 标 变换 可 知 ， 在 经 典 |CP 间 题 中 ， 给 定 了 两 组 3D 点 ， 我 们 要 计算 它们 之 间 的 变换 算 阵 。 假 设 第 一 组 3D 扣 为 P={pili= (1，2， 
…， NN) }， 第 二 组 3D 操 为 Q={qiji= (1，2，…，N) }， 那 我 们 实际 要 做 的 事情 是 求 一 个 欧 氏 变换 所 阵 T， 使 得 T 满 足 : yi，qi=Tpi; 特殊 欧式 群 SE (n) 残 
是 李 代数 下 的 n 维 欧 氏 变换 ， 这 里 取 n=3 时 (与 三 维族 转 群 SO (3) 对 应 ) ，SE (3) 的 正式 记 法 如 下 : 


R TT 
0 | 


SE(3) = 1G = | eR™ |Re SO0(3),reR:| (3-19) 





每 个 变换 矩阵 有 六 个 自由 度 ， 故 对 应 的 李 代数 位 于 Re 中 ， 于 是 se (3) 的 正式 记 法 如 下 : 
se (3) ={5A 人 ER4x45ER6} (3-20) 


此 时 的 符号 ^ 不 再 对 应 一 个 反对 称 关系 ， 而 是 表示 : “ [| “| 。 "|; 可 以 看 到 ，E 的 前 三 维 为 旋转 向 量 ， 后 三 维 为 平移 向 量 。 和 前 面 的 三 维 旋转 群 类 


似 ， 对 9- |。 ,网 体 变换 矩阵 求 导 得 : 


R(ARG)™ T(t) - RG)R(G) TL) 


G(TG- tS = | 
0 0 


于 是 0) “各 《1) (1)， 计 算 微分 方程 后 得 到 : G (t) =exp [5 (tb “] ， 于 是 与 前 面 三 维 旋转 群 SO (3) 对 应 的 李 代数 so (3) 类似 ， 就 可 以 
得 到 se (3) 上 的 指数 映射 如 下 : 
es mW Jp 
exp| (2)| = 
0 |] 


上 陈 中 由 为 前 文 介绍 的 so (3) 的 元 素 ，J 可 整理 为 如 下 形式 : 








Fe YY 本 (1 sing Jaa i Ge 17A (3-23) 


3.2 KITTI 数 据 集 介绍 


J1 口 


:全 


KITTI 数 据 集 由 德国 卡尔 斯 鲁 厄 理工 学 院 和 丰田 美国 技术 研究 院 联合 创办 ， 是 目前 国际 上 最 大 的 智能 汽车 场景 下 的 计算 机 视觉 算法 评测 数据 集 L19， 


是 
一 个 测试 交通 场景 中 车 辆 检测 、 车 辆 追踪 、 语 义 分 割 等 算法 的 公开 数据 集 。KITTI 包 含 市 区 、 乡 村 和 高 速 公 路 等 场景 采集 的 真实 图 像 数据 ， 每 张 图 像 中 最 多 
达 15 辆 车 和 30 个 行人 ， 还 有 各 种 程度 的 庶 挡 与 截断 。 


3.2.1 KITT 数据 集 及 集 平 台 


KITTI 数 据 集 采集 平 台 如 图 3-4 所 示 。 


360” 激光 扫 摘 仪 





图 3-4 KITTI 数 据 集 采集 平台 
该 平台 上 装载 了 如 下 设备 : 


.一 对 采样 频率 为 10Hz 的 140 万 像素 彩色 摄像 头 (FL2-14S3M-C) 、 


索尼 ICX267CCD、 全 局 快门 。 
一 对 采样 频率 为 10Hz 的 140 万 像素 黑白 摄像 头 (FL2-14S3M-C) 、 


索尼 ICX267CCD、 全 局 快门 。 
一 个 采样 频率 为 10Hz 的 Velodyne HDL-64E LiDAR， 分 辨 率 为 0.02m/0.09"， 采 集 速 率 为 130 万 点 / 秒 ， 视 野 为 360?" 水 平 、26.8" 垂 直 ， 范 围 为 120m。 
一 个 OXTS RT3003 惯 性 导航 系统 和 一 个 GPS 导航 系统 ，6 轴 ， 采 样 频率 为 100Hz， 分 辨 率 为 0.02m/0.1?。 

:于 是 通过 


该 平台 便 可 以 采集 到 周围 环境 ， 比 如 图 3-5 中 平台 采集 的 图 片 包括 了 道路 、 行 人 、 居 民 楼 等 





图 3-5 KITTI 数 据 集 的 样本 


KITTI 数 据 集 主要 用 于 评测 立体 图 像 (Stereo) 、 光 流 (Optical Flow) 、 场 景 流 (Scene Flow) 、 视 觉 里 程 计 (Visual Odometry) 、 对 象 检测 
(Object Detection) 和 跟踪 、 道 路 检测 (Road/Lane Detection) 等 计算 机 视觉 技术 在 车 载 环 境 下 的 性 能 。 


2015 年 的 Stereo/Optical Flow/Scene Flow 基 准 包 含 200 个 训练 场景 和 200 个 测试 场景 (每 个 场景 的 4 个 彩色 图 像 ， 保 存 为 PNG 格 式 ) 。KITTI 的 评估 
服务 器 用 来 计算 所 有 测试 图 像 (200 个 ) 中 所 有 地 面 真实 像素 里 坏 像素 的 百分比 。 对 于 这 个 基准 ， 如 果 视 差 小 于 3pxl 或 者 Flow 终 点 误差 小 于 59%， 就 认为 
该 像素 被 正确 估计 。Stereo 数 据 集 的 示意 图 如 图 3-6 所 示 。 





图 3-6 ” Stereo 数据 集 (2015 年 ) 示意 图 


视 完 里 程 计 (Visual Odometry，VO) 基准 由 22 个 立体 声 序列 组 成 ， 保 存 为 PNG 格 式 。KITTI 数 据 集 提供 11 个 序列 (00 ~ 10) 和 训练 序列 的 11 个 序列 
(11~21) ， 没 有 地 面 真 值 进行 评 售 。 对 于 这 个 基准 测试 ， 使 用 者 可 以 使 用 单 目 或 立体 视觉 测 距 ， 基 于 激光 的 SLAM 或 结合 视 交 和 LiDAR 信 息 的 算法 提供 
结果 。 唯 一 的 限制 是 要 求 使 用 万 法 是 全 目 动 的 〈 例 如 ， 不 允许 手动 闭环 标记 ) ， 并 且 所 有 序 询 使 用 相同 的 参数 集 。 开 上 及 工具 包 提供 了 有 关 数 据 格 陈 的 详细 
信息 。 视 竞 里 程 计 数据 集 如 图 3-7 所 示 。 





图 3-7 视觉 里 程 计 数据 集 示 意图 


3. 对 象 检测 数据 集 


对 象 检测 数据 集 包 括 2D、3D 和 乌 隔 视角 ( 见 图 3-8) 。 目 标 检测 和 目标 方向 估计 基准 包括 7481 个 训练 图 像 与 7518 个 测试 图 人像， 总 共 包 括 80256 个 标记 
对 象 (所 有 图 像 都 是 彩色 的 并 保存 为 PNG 格 式 ) 。 为 了 进行 评估 ， 人 研究 人 员 计 算 了 目标 检测 的 精确 回忆 曲线 和 联合 目标 检测 与 方向 估计 的 方向 相似 回忆 曲 
线 。 在 后 一 种 情况 下 ， 不 仅 要 正确 定位 对 象 的 二 维 边界 框 ， 而 且 还 要 评估 乌 梧 图 中 的 方向 估计 。 排 序 的 方法 是 计算 平均 精度 和 平均 取向 的 相似 性 。 要 求 所 
有 万 法 对 所 有 测试 对 象 使 用 相同 的 参数 集 。 开 友 套 件 提供 了 有 关 数 据 格式 的 详细 信息 以 及 用 于 读 写 标签 文件 的 MATLAB/C++ 实 用 程序 功能 
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a ) 2D 对 象 检测 数 据 集 示 意 图 








c) 马上 梧 视角 对 象 检测 妆 据 集 示 介 图 


图 3-8 ”对 象 检测 数据 集 示意 图 


4. 对 象 跟 跃 数据 集 


对 象 跟踪 数据 集 手工 标注 ， 基 准 包括 21 个 训练 序列 和 29 个 测试 序列 ， 主 要 包括 行人 和 轿车 ( 见 图 3-9) 。 





5. 道路 检测 数据 集 


道路 检测 数据 集 由 手工 标注 ， 基 准 是 由 本 田 欧洲 研究 所 的 詹 尼 克 : 弗 里 奇 (Jannik Fritsch) 和 托 比 亚 斯 : 库 恩 (Tobias Kuehnl) 合作 创建 的 。 道 路 和 车 
道 估计 基准 包括 289 个 训练 图 像 和 290 个 测试 图 像 。 它 包含 三 个 不 同类 别 的 道路 场景 : 未 标明 和 车道、 标明 双向 单车 道 、 标 明 双 向 多 和 车道 。 地 面 真 值 是 通过 手 
动 注释 图 像 产 生 的 ， 可 用 于 两 种 不 同 的 道路 地 形 类 型 : 道路 -道路 区 域 ， 即 所 有 车 道 的 组 成 ;车 道 -自行 车 道 ， 即 车 辆 所 在 的 车 道 。 只 有 训练 图 像 提 供 真 实 


情况 〈 见 图 3-10) 。 


和 a UMM 


ge 





图 3-10 ”道路 检测 数据 集 示 意图 
[1] px 有 是 pixel 的 缩写 。 


3.2.3 KITT 数据 集 的 格式 介绍 


图 3-11 是 对 于 KITTI 格 式 的 基本 介绍 。 


#Values Name De 

1 type Describes the type of object: Car, ‘Van’', Trueck”’, 
Pedestrian’', 'Person sitting’, ‘Cyclist', ‘Tram’, 
Misce' or ‘DontCare’ 

1 truncated Float from @ (non=trunctated) to 1 (truncated), where 
truncated refers to the object leaving image boundaries 

1 ocecluded Integer (8@,1,2,3) indicating Ocelusion state: 
9 = fully visible, 1 = partly occluded 
2 = larpely occluded, 3 = unknown 

1 alphs Dbaervation ngEle of bject, ranging [=-p1..p1] 

bbox 2D boundine box of obiject in the imaee (@-based index): 

contains left, top, right, bottom pixel coordinates 


3 dimensions 3D object dimensiaons:; height, width, length (in meters’) 

EE location 3D object location xyyyz In camera coordinates (in meters) 
1 rotation ¥ Rotation ry around Y-axis in camera coordinates [=-pi..pi] 
1 seEore DNnly for Fesults: Float, indicatine contidence in 


detection, needed for p/r curves, higher is better., 


Here, ‘DontCare’ labels denote regions in Which objects have not been labeled, 
tor example because they have been too tar Bway from the laser scanmer, To 
prevent such objects from being counted as false positives our evaluation 
seript will ignore objects detected in don't care repgions of the test set., 

YOu tan Use the don't care labels in the training set to avoid that your object 
detector 15 harvesting hard negatives from those areas, in case you consider 
non=-object regions from the training images as negative examples,. 


图 3-11 KITTI 数 据 集 格式 介绍 
资料 来 源 ， 图 片 来 自 https://github.com。 
为 了 直观 解释 ， 这 里 给 出 一 个 例子 : Car 0.000-0.9599.36144.17583.27199.521.251.553.012.041.3529.11-1.72。 第 1 个 字段 “Car” 是 目标 类 别 ， 除 
了 “Car” 以 外 还 有 多 个 类 别 ; 第 2 个 字段 “0.00” 是 截断 标志 ， 这 里 代表 物体 未 被 截断 ;第 3 个 字段 “0” 是 遮挡 程度 ， 这 里 代表 没有 被 遮挡 ; 第 4 个 字 
及 “-0.9” 是 观察 角度 ; 第 5 个 字段 “599.36144.17583.27199.52” 是 目标 的 左上 角 和 右 下 角 坐 标 ;第 6 个 字段 “1.251.553.01” 是 物体 的 三 维 尺度 长 宽 
高 ; 第 7 个 字段 “2.041.3529.11” 是 3D 标 注 的 坐标 ; 第 8 个 字段 “-1.72” 是 相对 Y 轴 的 旋转 角度 。 


与 以 往 计 算 机 视 癌 领域 的 数据 集 相 比 ，KITTI 数 据 集 利用 多 种 传感器 收集 更 接近 实际 情况 的 数据 ， 才 盖 到 了 智能 汽车 应 用 的 各 个 领域 ， 因 此 许多 研究 者 


都 基于 这 个 数据 集 进行 研究 工作 ， 在 该 数据 集 上 进行 新 算法 的 测试 ， 从 而 获得 比较 可 信 的 结果 。 


3.3 ”基于 多 特征 融合 的 道路 理解 万 法 


道路 环境 理解 作为 王 辆 主动 安全 系统 和 目 主 驾驶 关键 技术 ， 被 广泛 应 用 于 智能 汽车 、 芋 道 偏 衫 预警 系统 (LDWS) 以 及 目 适应 巡航 控制 (ACC) 等 领 
域 。 车 道 标 识 线 作为 明显 的 道路 特征 ， 具 有 移 验 可 知性 和 识别 鲁 棒 性 。 使 用 机 器 视 竞 扩 术 理解 道路 环境 具有 成 本 低 、 信息 量 大 和 适应 性 好 等 优点 。 


目前 ， 车 道理 解 研究 方法 主要 有 两 种 : 基于 特征 的 方法 和 基于 模型 的 方法 Bl。 基 于 特征 的 方法 利用 道路 与 背景 特征 差异 将 道路 从 背景 中 分 割 出 来 ， 如 
道路 边缘 梯度 全 站、 道路 方向 I9 等 ， 算 法 在 非 结构 化 道路 识别 中 得 到 了 较 多 的 应 用 四， 基于 特征 的 方法 的 识别 效率 较 高 ， 但 是 对 阳光 、 阴 影 、 水 渍 等 复杂 
环境 敏感 。 和 基于 特征 的 方法 不 同 ， 基 于 模型 的 方法 使 用 数学 模型 描述 车 道 ， 如 抛物 线 ! 沾 、 样 条 曲线 [9、 双 曲线 等 ， 道 路 数学 模型 参数 估计 的 常用 方法 
有 Hough 变 化 方法 Ho0、 最 大 后 验 概率 估计 I 1、 主 动 轮廓 11 等。 基于 模型 的 方法 的 识别 鲁 棒 性 较 好 ， 但 是 需要 基于 道路 平坦 、 左 右 车 道 线 平行 等 假设 ， 


算法 的 计算 量 大 ， 识 别 效率 较 低 。 


为 此 ， 本 节 针 对 道路 理解 万 法 难以 在 效率 和 重 棒 性 间 达 到 平衡 的 问题 ， 提 出 一 种 基于 多 特征 信息 融合 的 道路 边界 识别 与 跟 路 算法 。 该 算法 采用 多 特征 
言 息 融 合 的 方法 构造 车 道 置信 和 度 函 数 ， 提 高 识别 鲁 棒 性 ， 使 用 基于 最 小 风险 遂 数 的 道路 区 域 分 割 算法 来 提高 算法 的 实时 性 。 


3.3.1 ”人 道 路 环境 理解 算法 染 构 


道路 环境 理解 算法 所 需要 完成 的 任务 及 其 支撑 算法 框架 如 图 3-12 所 示 。 






识别 模式 
路 面 特征 | | 路 面 区 域 | | ”图 像 道路 标识 





提取 分 割 ”| | 预 处 理 线 识 剂 


Ee ee Pe md, J 
| 
| 
| 

二 有 -和 站。 a | 
窗口 漆 移 最 小 风险 bz- 放 | 车 道 置 信和 度 函 数 j| ， 
i i HR nH i 
路 面 区 域 国 数 道路 小 波 箭 沁 验证 下 的 概率 | | 
pi ee hent) > WE I 
搜索 算法 分 割 算 法 ”| |Hough 变 换 方法 | ， 
| 
图 3-12 ”道路 环境 理解 算法 框架 
算法 将 与 环境 相关 的 部 分 集中 到 系统 初始 化 阶段 完成 ， 在 初始 化 阶段 完成 高 耗 时 的 路 面 特征 提取 、 路 面 区 域 分 割 任务 ， 得 到 路 面 特 征 参 数 。 在 正常 识 


别 跟 踊 阶 段 ， 算 法 利用 视频 流 图 像 间 的 时 空 关联 性 ， 采 用 车 道 置信 和 度 消 数 验 证 下 的 概率 Hough 变 换 方 法 ， 完 成 识别 和 跟踪 任务 。 


3.3.2 ”基于 特征 融合 的 道路 区 工分 割 


道路 理解 首先 要 确定 候选 道路 在 目标 图 像 中 的 区 域 ， 对 道路 区 域 进行 有 效 分 割 。 过 大 的 道路 区 域 分 割 将 增加 道路 识别 和 跟 中 计算 量 ， 而 过 小 的 道路 区 


域 分 割 则 可 能 丢失 视 场 内 道路 信息 。 本 书 提出 在 最 小 风险 函数 下 融合 道路 边界 消失 点 、 道 路 区 域 消失 线 和 最 高 车 速 的 自 适应 分 割 方法 。 道 路 区 域 分 割 任务 
在 初始 化 阶段 完 


1. 道 路 边界 消失 点 估计 


根据 消失 点 理论 ， 物 理 空 间 内 两 条 平行 直线 投影 相交 于 图 像 平 面 中 的 同一 点 。 因 此 ， 在 道路 边界 平行 和 路 宽 不 变 的 假设 下 ， 可 见 道路 区 域 位 于 图 像 消 
失 点 下 方 区 域 。 道 路 边界 消失 点 采用 近视 场 区 域 Hough 变 换 方法 估计 ， 根 据 道路 先 验 知识 对 道路 直线 进行 筛选 ， 可 得 Hough 空 间 下 左右 道路 边界 数学 表示 
如 下 : 


[pr vcost, + ycosg, 


( 3-24) 
xcost, + yecos0, 


PR 


在 式 (3-24) 中 ，x 和 ly 分 别 为 点 的 横 坐 标 和 纵 坐 标 。9L 和 9R 分 别 为 左右 车 道 线 与 x 轴 正 半 轴 的 夹 角 ，plL 和 prR 为 坐标 原点 到 左右 车 道 线 的 距离 。 


一 段 有 曲率 的 道路 消失 点 如 图 3-13 所 示 ， 定 义 图 像 横 坐标 为 x 轴 ， 纵 坐标 为 y 轴 ， 左 上 和 角 为 坐标 系 原 操 ， 左 右 车 道 线 交 点 P1 为 消失 点 近似 值 。 


近视 场 





a ) 消失 点 搜索 b ) 基于 特征 窗口 漂移 的 路 面 区 域 搜索 


图 3-13 路面 区 域 分 割 方法 





2. 基 于 特征 窗口 漂移 的 路 面 区 域 搜索 


根据 先 验 燥 识 使 用 基于 亦 度 和 方差 的 相似 度 比较 方法 确定 特征 窗口 ， 并 同时 获得 当前 路 面 特征 参数 。 按 照 概率 原则 假设 视野 下 部 区 域 为 路 面 候选 区 
域 ， 窗 口 搜索 步 又 如 下 : 


(1) 在 图 像 下 边缘 处 随机 抽取 3 个 像素 为 20x20 的 特征 窗口 WI、W2、W3， 如 图 3-13b 所 示 。 


(2) 特征 窗口 在 x 轴 方 向 以 offsetX 为 步 长 单位 进行 漂移 ， 并 实时 计算 特征 窗口 方差 62， 直 到 小 于 方差 阐 信 ”时 停止 搜索 ， 如 果 x 轴 方向 搜索 失败 ， 
则 特征 窗口 沿 y 轴 向 上 平移 offsetY 后 继续 在 x 轴 方向 搜索 ， 直 到 搜索 成 功 。 特 征 窗口 在 调整 位 置 的 过 程 中 允许 碰撞 ， 但 不 能 重合 


其 中 ， 特 征 窗口 方差 用 如 下 变形 公式 计算 : 


| 人 |] Ml  、3? 
人 7 | ; 和 
br2 三 和 FP re (3-25) 
N 抬 MN 
在 式 (3-25) 中 ，x 为 特征 窗口 内 像素 点 的 灰 度 值 ，N 为 窗口 内 像素 数目 ，o“ 为 特征 窗口 方差 。 
(3) 特征 窗口 方差 在 先 验光 围 内 后 ， 计 算 各 特征 窗口 的 灰 度 值 ， 然 后 取 特 征 窗口 灰 度 Xy 为 min (X1，X2，X3) ， 并 验证 XW 是 否 小 于 炎 度 先 验 阅 


值 Xth。 如 果 验 证 成 功 ， 则 可 得 路 面 特征 窗口 参数 为 (XW，'“ W ，HwW) ，Hw 为 特征 窗口 灰 度 直方 图 ，“ W 为 特征 窗口 方差 ， 否 则 转 到 步骤 (1) 重新 启 


动 路 面 特 征 窗口 搜索 算法 。 
得 到 路 面 特征 窗口 参数 XW， 人 W ，Hw) 后 ， 根 据 特征 窗口 高 度 尺寸 H， 将 图 像 区 域 分 割 为 若干 个 高 度 也 为 H 的 平行 区 域 li (i=1，2，.…，n) ， 图 
像 分 割 如 图 3-14 所 示 。 以 路 面 特征 参数 为 模板 ， 特 征 相似 度 评价 指标 为 合并 准则 ， 对 路 面 区 域 进行 分 离 和 合并 。 路 面 区 域 生 长 方法 如 下 : 
(1) 以 特征 窗口 直方 图 HW 为 路 面 匹配 目标 模板 ， 在 | 评 行 区 域内 寻找 特征 匹配 系数 大 于 匹配 相似 度 国 值 dth 的 窗口 ， 设 其 直方 图 为 Hs， 特 征 相 似 度 
dc 评价 指标 的 计算 公式 如 下 : 


2, Hs(g) x Hwy(g) 


d(H.,H,) = (3-26) 


2 Hs (g) x Hw(g) 





Fr 1 Fr Fy FT ET 交 
在 式 (3-26) 中 ， H W ( 8) Hy | ( 1/M ) Hy (1) - ，M 为 直 万 图 中 bin 数 目 ，g, jE{1，2，.…，M)} 为 直 万 图 中 
bin 索 引 标 号 ，WE{s，9g}。Hs (9) 为 直方 图 Hs 第 g 个 bin 内 的 归 一 化 数值 ，Hw (9) 为 直方 图 Hw 第 g 个 bin 内 的 归 一 化 数值 。 当 两 个 直方 图 完全 匹配 


时 ,dc (Hs，Hw) =1， 反 之 为 0。 
(2) 大 找到 匹配 系数 大 于 靖 值 dth 的 窗口 HS， 则 认为 匹配 成 功 ， 设 置 P (li) =TRUE， 否 则 将 窗口 上 下 拆 分 为 两 个 相连 的 平行 窗口 ， 并 分 别 在 两 个 窗口 
内 ， 重 复 步 骤 (1) 的 特征 窗口 搜索 操作 。 


(3) 将 P (liullo 设置 为 TRUE， 其 中 k=1，2，.…，n。 


(4) 当 拆 分 的 窗口 高 度 小 于 立 值 Hthn 时 操作 停止 ， 取 最 上 方 的 窗口 x 坐标 为 道路 区 域 分 割 线 的 图 像 坐标 (XH，yH) 。 





图 3-14 路 面 区 域 生 长 方法 





道路 区 域 分 割 的 大 小 影响 到 道路 识别 与 跟踪 算法 的 计算 量 以 及 道路 信息 完整 性 ， 综 合 考虑 道路 边界 消失 点 P(Xyvy，yv) 、 路 面 区 域 消失 点 


PH (xH，yH) ， 以 及 最 高 车 速 要 求 的 视野 预 瞄 点 Pp (Xp，yp) ， 提 出 最 小 风险 立 数 据 标 中 。 


y= Dw (P, -Pp,) (3-2 


在 式 (3-27) 中 ，Pe 分 别 取 Py，PH，Pp，N=3，wi 为 各 子 项 权重 系数 ， 由 经 验 决定 ， 中 为 最 小 风险 标 称 值 。 希 望 得 到 的 图 像 道 路 区 域 分 割 点 束 是 使 由 


最 小 时 的 P+ 所。 


3.3.3 ”道路 建 模 与 随 动 方向 滤波 器 
1. 道 路 建 模 与 求解 


常用 道路 模型 有 直线 道路 模型 、 抛 物 线 道路 模型 、 双 曲线 道路 模型 、 样 条 曲线 道路 模型 等 [3 引 。 本 书 引 入 一 次 B 样 条 多 线段 模型 建立 道路 模型 ， 相 比 其 
他 曲线 模型 ， 使 用 多 线段 模型 降低 了 算法 复杂 度 。B 样 条 曲线 的 定义 如 下 : n+1 个 控制 点 P; (r=0，1，.……，n) ，N 阶 (N-1 次 ) 的 B 样 条 曲线 Pt 的 表达 式 
为 : 


P, = PF,,(t) te[0,1 (3-28) 
r= 


在 式 (3-28) 中 ，Pr 为 控制 点 ，n 为 B 样 条 阶 数 ，Fr， n(t) 为 B 样 条 基 荡 数 ， 其 形式 为 : 


nC— 


pA | ] ) 工 (- 1)C (t+no-ro-s) 


7 


(n+1)! 


or Cn tl sl! (3-29) 


对 于 给 定 参数 轴 上 的 节点 序列 ; t0，t1，...，tm， 当 m 取 2，bEe{1，2，...，mJ 时 ,可 以 得 到 一 次 (二 阶 ，B 样 条 折线 模型 公式 如 下 : 


1/ 一 1! 
bts 
b+l 6 
B,,(t) 一 eg (3-30) 
1 1 bi 三 L = 1 2 
b+2 b+l 
0 其 他 
在 道路 识别 和 跟 蹊 阶段， 为 了 减少 算法 计算 工作 量 ， 在 各 分 割 区 域 沁 围 内 使 用 直线 拟 合 道路 边界 ， 然 后 将 各 分 割 区 域内 得 到 的 多 线段 首位 相 接 得 到 一 


次 B 样 条 折线 模型 。 


在 道路 模型 求解 阶段 ， 根 据 折线 模型 中 各 线段 的 斜率 相似 度 ， 当 和 斜率 相似 度 大 于 或 等 于 和 斜率 相似 度 辣 值 Kth 时 ， 使 用 直线 拟 合 道路 标识 线 ， 当 和 斜率 相似 
度 小 于 Kth 时 ， 玉 用 最 小 二 乘 ; 去 ， 使 用 曲线 拟 合 道路 标识 线 。 


喝 。 


人 





图 3-15 ”高 斯 卷 积 核 平面 投影 


2. 方 向 随 动 滤波 器 


人 几 旦 和 


在 图 像 预 处 理 阶 段 ， 本 书 引入 方向 随 动 滤波 器 ， 选 取 各 向 异性 高 斯 核 作 为 基 滤 波 器 ， 如 式 (3-31) 所 示 ， 高 斯 卷 积 核 平面 投影 如 图 3-15 所 示 。 


Coa) = Gexzp(- 了 (全 + 写 ) (3-31) 


在 式 (3-31) 中 ，d1=ucos9+vsin6，d2=ucosb - vsin9，Gx, y 为 高 斯 卷 积 核 基 消 数 ，G0 为 配 分 常数 ，01、02 为 高 斯 核 的 尺度 系数 ，9 为 滤波 器 方 
向 角 ，u 为 高 斯 核 长 半 轴 方向 ，v 为 高 斯 核 短 半 轴 方向 。 

对 于 视频 流 而 言 ， 连 续 视 频 帧 间 道 路 方向 变化 不 大 ， 因 此 可 将 兴趣 区 域内 的 上 一 次 道路 方向 与 图 像 坐标 系 夹 角 作为 本 次 滤波 器 方向 角 输 入 ， 并 根据 各 
区 域 道路 方向 的 变化 趋势 ， 实 时 随 动 调整 滤波 器 方向 角 输入 。 

需要 指出 的 是 ， 在 初始 车 道 线 检测 时 ， 我 们 并 不 知道 各 兴趣 区 域内 车 道 线 的 方向 ， 为 了 得 到 方向 随 动 滤波 器 的 角 输 入 ， 采 用 耗 时 较 多 的 Canny 边 缘 检 
测 方法 在 全 方向 角 范 围 内 检测 道路 边缘 。 


3.3.4 ”基于 置信 和 度 消 数 的 道路 标 线 识 别 


根据 相机 透视 原理 ， 车 辆 坐标 系 中 的 直 绪 边缘 在 经 过 相机 成 像 后 ， 在 无 畸变 图 像 平面 上 仍然 映射 为 直线 。 根 据 此 原理 ， 通 过 合理 分 割 图 像 道路 区 二 一 


方面 可 以 使 曲线 道路 的 折 续 通 近 度 最 高 ， 另 一 方面 可 以 在 各 分 区 范围 内 分 别 设置 感 兴 趣 区 域 ， 减 少 噪 声 对 识别 结果 的 影响 。 
本 书 诈 移 在 车 辆 坐标 系 内 以 通 近 误差 为 约束 条 件 ， 对 车辆 前 方 区 域 进行 平行 分 区 ， 然 后 将 分 区 映射 到 图 像 坐 标 系 中 ， 保 证 图 像 坐 标 系 分 区 范围 内 的 直 
线 拟 合 误差 精度 ， 道 路 区 域 分 区 方法 如 图 3-16 所 示 。 





ss 车 载 相机 投影 
NS 等 间距 


平行 分 区 





a ) 车 辆 坐标 系 等 中 分 割 b ) 图 像 坐 标 系 映射 
图 3-16 ”道路 区 域 分 区 方法 
道路 区 域 分 区 需要 综合 考虑 最 高 车 速 要 求 和 行驶 道路 环境 ， 选 取 合适 的 区 域 划分 距离 ， 窗 口 分 区 步骤 如 下 : 


(1) 在 车 辆 坐标 系 中 布置 平行 区 域 ， 行 数 为 10 行 ， 由 近 及 远 。 行 间距 离 根据 最 高 车 速 和 预 瞄 时 间 综 合 确定 ， 本 书 定 为 ?m， 平 行 区 域 间 无 间 阶 。 


(2) 将 车 辆 坐标 系 中 的 平行 窗口 按照 相机 透视 原理 投影 到 二 维 图 像 平 面 进 行 分 区 ， 得 到 图 像 平 面 内 的 道路 区 域 分 区 ， 并 分 别 标记 为 
Al (h=1，2，3，...，10) 。 


识别 模块 得 到 的 标识 线 结果 是 否 属 于 道路 边界 的 概率 主要 取决 于 直线 方 同 、 和 直线 到 和 车辆 的 距 


离 、 道 路 标识 线 宫 度 、 像 素 灰 度 以 及 左右 车 道 间 宽度 等 综 
合 因 素 ， 单 一 特征 无 法 给 出 确信 结果 。 因 此 我 们 需要 斋 合 先 验 车 道 特征 信息 ， 通 过 构建 车 道 置 信和 度 消 道 


数 来 评价 识别 结果 为 车 道 线 的 可 信 程度 。 

这 里 提出 的 车 道 置 信和 度 公 式 如 下 : 

L (S) =nex [ngxga (6A) tnaxfq (da) +nIxIda (u, V) J (3-32) 

为 了 便于 数值 比较 ， 式 中 L(S) 值 以 贴近 度 形 式 统一 到 [0，1] 区 间 。 其 中 ，n6 为 王道 线 斜 率 因 子 ，ng，nd，ml 为 权重 系数 ， 且 有 ng+nd+nli=1。 关 于 
式 (3-32) 的 详解 如 下 : 


(1) 对 于 和 车道 线 而 言 ， 图 像 坐 标 系 内 左右 车 道 线 与 车 辆 纵向 夹 角 9 始终 在 一 定 汽 围 内 变化 。 根 据 道路 试验 经 验 ， 定 义 左 车 道 线 与 车 辆 纵向 夹 角 9| 属 于 
[25”"，65°]， 石 车 道 线 与 车 辆 纵向 夹 角 9R 属 于 [115*，155°] 时 ne 为 1， 其 余 情况 ne 为 0。 


(2) 车 道 置信 和 度 消 数 考虑 了 左右 车 道 线 同时 识别 成 功 与 仪 成 功 识别 某 一 侧 边 界 时 的 情况 。gq (6A) 为 左右 车 道 线 平行 程度 的 量度 ， 当 左右 车 道 线 均 
被 识别 到 时 ，91 取 96L，92 取 69R， 当 只 识别 到 一 侧 车 道 线 时 ，gd (6A) 为 连续 两 帧 图 像 中 同一 侧 车 道 线 的 角度 变化 范围 ，901 取 90i，92 取 0i-1。gd (9A) 的 
定义 如 下 : 
gq (A) = [cos (61 一 92) +1] /2 (3-33) 
(3) 车 道 间 宽 度 是 车 道 置信 和 度 评 价 的 重要 指标 ， 本 书 假设 车 道 冤 度 恒定 且 宽 度 值 为 4d，d| 为 车 辆 到 左 车 道 线 的 距离 ，dR 为 车 辆 到 右 车 道 线 的 距离 。 计 
算 公式 如 式 (3-34) 所 示 ， 左 右 车 道 线 间 的 距离 越 接 近 路 宽 q， 其 对 车 道 置 信 度 冰 数 的 贡献 越 大 。 


fa (CdqA) =1 一 arctan (| drtdr—d|) (3-34) 


(4) ld (u，v) 为 待 检测 车 道 线 上 所 有 像素 灰 度 和 归 一 化 后 的 数值 。 在 式 (3-35) 中 ， 入 为 像素 点 个 数 , | (u，v) 为 各 像素 灰 度 值 ，Q 为 直线 区 域 像 
素 点 空间 。1lg(u，v) 的 数值 越 高 对 车 道 置信 和 度 消 数 的 贡献 越 大 。 


T,(u,v) = > I(u,v) (3-35) 


] 
入 (uv)en 


3. 基 于 随机 Hough 变 损 的 车 道 识别 算法 


受到 Kokonen 自 组 织 映 射 神 经 网 络 算法 的 启发 ，Xu 等 人 于 1993 年 提出 了 随机 Hough 变 换算 法 [1 及。 算法 采用 收敛 映射 、 随 机 抽样 以 及 动态 连接 列表 技 
术 取代 传 统 Hough 变 换 中 的 穷 举 和 一 对 多 映射 方法 ， 缩 得 了 存储 和 运算 时 间 ， 用 在 车 道 边界 识别 领域 可 极 大 地 提高 识别 效率 。 


本 书 提出 的 车 道 识 别 算法 主要 包括 两 个 模块 : 识别 初始 态 和 识别 正常 态 ， 模 块 间 切换 由 错误 预警 模块 管理 。 当 连续 三 帧 图 像 中 人 至少 有 一 帧 图 像 的 左右 
道路 线 被 同时 检测 到 时 ， 预 警 模 式 切 换 到 识别 正常 态 中 ， 否 则 道路 识别 程序 启用 高 耗 时 但 鲁 棒 性 强 的 识别 初始 态 ， 路 面 识别 算法 流程 如 图 3-17 所 示 。 


算法 工作 时 ， 感 知 模 块 首先 进入 识别 初始 态 ， 此 模式 中 算法 主要 完成 道路 区 域 分 割 和 特征 提取 等 路 面 环 境 参 数 提取 任务 ， 算 法 主要 包括 窗口 漂移 路 面 
区 域 搜索 算法 、Canny 边 缘 提 取 算 法 、 基 于 最 小 风险 浮 数 的 道路 区 域 分 割 算法 等 。 识 别 初始 仿 阶段 完 成 后 感知 程序 进入 路 面 识 别 正 常态 ， 在 此 模式 中 程序 
依次 在 A1 区 到 A9 区 中 使 用 方 周 可 调 滤波 器 进行 图 像 预 处 理 ， 然 后 使 用 车道 置信 和 度 阔 数 和 随机 Hough 变 换 进 行道 路 边界 搜索 ， 最 终 完 成 王道 标识 识别 任务 。 


3.3.5 ”基于 粒子 对 滤波 的 道路 续 跟 踩 


道路 特征 提取 目标 是 获取 路 面 上 代表 道路 标识 线 的 区 域 。 考 虑 到 大 多 数 情 况 下 道路 标识 线 具有 左右 对 称 这 一 特征 ， 这 里 对 传统 粒子 滤波 算法 进行 改 
进 ， 提 出 距离 约束 下 的 粒子 对 思想 并 将 其 作为 算法 的 基本 数据 处 理 单 元 ， 将 改进 后 的 粒子 对 滤波 算法 应 用 到 道路 跟踪 模块 的 特征 提取 阶段 。 


改进 的 粒子 对 滤波 算法 在 路 宽 不 变 的 假设 下 ， 根 据 左右 特征 粒子 间 的 横向 距离 为 路 宽 的 先 验 知识 ， 将 高 斯 分 布 在 左右 车 道 线 上 的 粒子 成 对 地 联系 起 
RT. ( alwN 


来 ， 用 市 有 权重 系数 的 粒子 对 来 表示 车 道 线 后 验 概率 密度 浮 数 。 其 中 ，z1 ; k 为 K 时 刻 的 观测 状 


= ,xx 
Ww Ee 9 Xi k™ Xp : 


态 ，Np 为 粒子 数量 ， “为 粒子 对 的 归 一 化 权重 系数 ,满足 “ ”为 左右 车 道 线 在 k 时 刻 的 状态 。 粒 子 对 的 归 一 化 权重 计算 需要 同时 考虑 
两 个 成 对 粒子 特征 窗口 中 的 道路 标识 线 置信 度 系数 。 


人 循环 读 入 
视频 图 像 


预警 为 路 面 识别 预警 模 预 等 为 
We 识别 预警 模式 
识别 初始 态 mi 识别 正常 态 





使 用 和 窗口 深 移 路 和 面 区 域 搜索 算法 
得 到 路 面 特征 


根据 前 帧 道路 方 问 特征 使 用 方 四 
滤波 如 对 图 像 Alx 进 行 处 理 


根据 路 面 特征 ， 进 行 目 适 应 国 值 


参 : 吾 县 J A 
分 割 ， 得 到 二 值 化 图 像 使 用 局 中 道路 参数 信息 对 Ai 


进行 二 值 化 、 边 绿 特 征 提 取 和 随 
机 Hough 直 线 参 数 估计 


首先 使 用 Canny 边 缘 提 取 算 法 提 
取 图 像 边缘 。 使 用 随机 Hough 变 换 
进行 参数 估计 ， 得 到 包含 道路 在 内 
的 直线 


使 用 车 起 置信 和 诬 图 数 对 Ag 进行 
目标 道路 过 涯 和 拥 取 


滤波 ， 使 用 车 道 阐 信 和 度 男 数 计算 
目标 征 线 阐 信 度 


利用 Alx 车 道 线 科 这 特征 信息 
在 Ax 设 置 ROI 区 域 ， 缩小 搜索 
范围 ,提取 车 道 标识 


依次 根据 前 一 道路 分 割 区 域 
Ar 的 道 线 特点 对 A 进行 道路 
特征 提取 


初始 化 完成 ， 根 据 车 速 要 求 进行 
路 面 区 域 分 割 ， 保 存 特征 参数 。 转 
入 识别 正常 态 





和 次 列 初始 态 


GB sa = = 4 


识别 正音 态 


Si 


-是否 成 功 获取 道路 


根据 斜率 和 距离 等 进行 道路 预 | 


图 3-17 ”路面 识别 算法 流程 
在 粒子 对 滤波 算法 下 ， 道 路 标识 线 跟踪 问题 可 转化 为 寻找 最 优 道 路 特征 粒子 ， 使 得 粒子 所 表示 的 特征 窗口 内 车 道 标识 线 置信 和 度 最 高 的 问题 。 其 具体 步 
又 如 下 : 
(1) 滤波 器 初始 化 。 识 别 阶 段 可 得 到 分 割 区 域 中 道路 标识 线 的 初始 位 置 和 道路 特征 参数 。 初 始 化 粒子 时 ， 将 粒子 对 高 斯 分 布 在 车 道 线 附近 ， 分 布 概率 
密度 函数 服从 零 均 值 单 峰 高 斯 分 布 ， 数 学 期 望 ux 为 各 分 割 区 域 车 道 线 横 坐 标 。 


时 人 一 and (i st ) 7 ll (3-36) 


nit 


X 
在 式 (3-36) 中 ， ”为 粒子 初始 分 布 ，rand 函 数 为 随机 分 布 函数 ，uinit 为 初始 化 时 各 分 割 区 域 车 道 线 横 坐 标 ，oinit 为 高 斯 分 布 标 准 差 。 
(2) 粒子 对 状态 动态 更 新 。 粒 子 对 状态 的 更 新 过 程 实质 上 是 根据 车 道 线 自主 运动 趋势 对 道路 未 来 状态 的 预测 传播 过 程 ， 这 里 的 预测 传播 过 程 采 用 一 阶 
自 回 归 模 型 (Auto-Regressive Process，ARP) 。 


CXT， XR) k=A CXT， XR) k—1tBVk=1 (3-37) 


式 中 ， (XL，XR) k 为 左右 车 道 线 的 粒子 对 状态 ，vk-1 为 粒子 对 动态 更 新 时 的 系统 噪声 ，A 和 B 为 转移 系数 ， 这 里 取 值 为 1。 


(3) 粒子 对 特征 似 然 度 估计 。 特 征 似 然 度 估计 需要 同时 考虑 两 部 分 因素 ,一 方面 要 计算 当前 粒子 对 左右 粒子 所 处 位 置 的 道路 特征 似 然 度 ， 如 像素 灰 
度 、 像 素 梯度 值 、 梯 度 方向 等 ， 另 一 方面 还 要 计算 距离 约束 下 左右 粒子 道路 特征 的 匹配 程度 。 


1(z|p) = > [7ng(d)sinpl + 7,g(d,)sing, +cos(P - 9,)) 


(u,v) 


(3-38) 


式 中 ,，L (z | 中 ) 为 粒子 对 特征 相似 度数 值 ，Tm 是 当前 粒子 所 处 图 像 位 置 的 像素 梯度 值 ，d 和 dl 分别 是 粒子 到 上 一 次 左右 道路 模型 的 距离 ，g (:) 为 
距离 qd 和 dr 的 归 一 化 算 子 ， 中 1 和 中 2 分 别 是 粒子 边缘 梯度 方向 与 上 一 次 道路 模型 方向 之 间 的 夹 角 。 


(4) 粒子 对 权重 更 新 。 根 据 历史 数据 和 本 次 观察 对 粒子 对 的 权重 进行 更 新 ， 采 用 陈 (3-39) 对 粒子 对 权重 进行 递 推 运算 。 


Ww = w” xL(z|ow) (3-39 ) 


配 


(5) 粒子 对 重 采 样 。 设 置 粒子 对 权重 国 值 Wth， 舍 痉 权 重 小 于 靖 值 的 粒子 ， 从 权重 较 大 的 粒子 上 衍生 出 新 的 蔡 代 粒子 。 同 时 ， 为 了 保证 粒子 分 布 的 后 


/— 


尾 特性 ， 在 粒子 对 重 采 样 时 只 有 85% 使 用 式 (3-39) 进行 采样 ， 其 余 仍 按照 式 (3-37) 进行 采样 。 


3.3.6 ”试验 结果 与 分 析 


试验 采用 的 一 部 分 测试 图 像 来 自 卡 内 基 梅 隆 大 学 (CMU) 智能 车 辆 研究 小 组 (图像 大 小 为 240x256 像 素 ) ， 这 些 图 像 被 世界 各 地 的 研究 者 应 用 于 测试 


各 种 车 道 检测 算法 [1 4; 另 一 部 分 来 自 车 载 视频 系统 采集 的 长 沙 至 株洲 高 速 某 路 段 场景 视频 ， 帧 率 为 15 帧 / 秒 。 


这 里 对 视频 中 的 2760 帧 图 片 进行 了 试验 ， 平 均 识 别 错误 率 小 于 9%， 每 帧 车 道 线 检测 平均 时 耗 为 22ms， 和 车道 续 跟 踩 平均 时 耗 为 3?ms， 满 足 实 时 性 要 
求 。 图 3-18 为 典型 道路 图 像 识 别 过 程 ， 其 中 图 3-18a 为 视频 原始 灰 度 图 像 ， 图 像 右 标识 线 被 右 侧 车 辆 阴影 训 挡 ; 图 3-18b 为 道路 区 域 分 割 和 分 区 结果 ， 分 割 
只 保留 与 道路 识别 有 关 的 图 像 区 域 ; 图 3-18c 为 对 道路 分 割 区域 进 行 自 适 应 二 值 化 和 边缘 提取 的 操作 结果 ， 算 法 消除 了 和 车辆 阴影 影响 ;图 3-18d 为 左右 车 道 


标识 线 识 别 结果 。 





a ) 原始 图 保 b ) 性 路 区 域 分 割 和 分 区 . 


Ee” 





c ) 二 值 化 与 道路 边 绿 图 像 d ) 识别 结果 图 像 
图 3-18 道路 识别 过 程 
图 3-19 展 示 了 典型 干扰 工 况 下 ， 道 路 环境 理解 算法 的 检测 结果 . 


图 3-20 展 示 了 不 同 曲 率 道路 工 况 下 的 道路 拟 合 结果 。 图 3-20a 中 和 芋 辆 前 方 道路 大 曲率 转弯 ， 此 时 折 续 模型 中 各 线段 斜率 相似 度 小 于 设 定 国 值 ， 算 法 用 
最 小 二 乘法 拟 合 道路 ;图 3-20b 中 前 方 道路 为 直线 ， 此 时 折线 模型 中 各 线段 斜率 基本 相同 ， 算 法 使 用 直线 模型 拟 合 道 路 标 线 。 


日 一 -+ 
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a ) 右 侧 本道 比 锌 阴影 慎 挡 





c ) 地 面 标志 干扰 d) 车 辆 通过 天 桥 阴 影 


图 3-19 ”典型 干扰 下 车 道 线 检测 结果 





a ) 道路 大 曲 鞭 转 薛 b ) 车 道 为 直线 ， 有 树 防 干扰 


图 3-20 ”不同 曲 率 道路 拟 合 结果 


试验 结果 表明 : 算法 对 于 结构 化 路 面 上 的 各 种 干扰 ， 如 车 辆 阴影 、 地 面 文字 和 标识 、 路 旁 树 从 阴影 、 强 烈 阳 光 天 气 等 都 具有 较 好 的 稳定 性 和 准确 性 。 
在 较 好 的 结构 化 路 面 上 平均 识别 正确 率 达 到 90% 以 上 ， 满 足 自主 车 辆 车 道 标 识 识 别 要 求 。 


3.4 ”基于 机 器 学 习 和 粒子 滤波 的 前 方 车 辆 识别 


车 辆 识别 与 跟踪 作为 环境 感知 系统 的 核心 技术 ， 可 以 有 效 地 降低 车 辆 追尾 等 辜 撞 危险 ,减少 人 身 伤亡 和 经 济 损失 。 在 城市 交通 环境 中 ， 车 辆 目标 类 
型 、 尺 寸 、 颜 色 和 环境 背景 等 非 确 定性 因素 众多 ， 容 易 导致 识别 与 跟 路 系统 不 稳定 ， 出 现 虚 警 和 漏 检 等 问题 。 


针对 这 一 情况 ， 本 节 对 前 方 车 辆 识别 与 跟踪 方法 进行 研究 ， 使 用 机 器 学 习 和 粒子 滤波 方法 进行 车 辆 目标 检测 ， 提 出 路 面 约 束 下 车辆 分 层级 联 识 别 与 多 
目标 跟踪 算法 。 


3.4.1 前方 车 辆 识别 问题 与 方法 


前 方 车 辆 视 党 识别 算法 需要 将 车 辆 从 静止 或 移动 的 背景 中 区 分 出 来 ， 为 后 续 决 策 和 控制 算法 提供 环境 信息 支持 。 城 市 环境 中 前 方 车 辆 识别 与 跟踪 是 极 
具 挑 战 性 的 任务 ， 其 困难 主要 表现 为 : 车 载 摄像 机 和 待 识 别 车 辆 目标 同时 运动 ， 存 在 拌 动 和 苏 艇 ;季节 和 天气 等 变化 市 来 的 光照 条 件 变 化 明显 ;， 在 途 行驶 
车 辆 类 型 众多 ， 各 上 自 具 有 不 同色 彩 和 外 形 特征 ;车 辆 进入 和 离开 摄像 机 视野 上 时， 速度、 尺寸 变化 较 大 ， 且 本 车 周围 可 能 同时 存在 多 台 和 车 辆 。 


目前 ， 研 究 者 提出 了 多 种 方法 来 解决 前 方 车 辆 识别 问题 。 主 要 可 忆 结 为 两 种 万 法 : 基于 信息 融合 的 方法 和 基于 移 验 知识 的 方法 。 其 中 ， 基 于 信息 融合 
的 万 法 需要 同时 处 理 多 种 传 感 数 据 ， 计 算 信 息 量 巨 大 ， 对 系统 要 求 较 高 ， 成 本 高 刷 。 基 于 先 验 知识 的 方法 以 车 辆 外 形 、 对 称 性 特征 和 底部 阴影 等 为 车 辆 目 
标识 别 基础 ， 系 统 重 棒 性 差 ， 受 光照 等 非 确 定性 因素 影响 严重 。 


一 般 情况 下 ， 图 像 目 标识 别 算法 需要 对 整 幅 图 像 进行 搜索 ， 并 借助 观测 方法 和 计算 手段 ， 实 现 对 待 识别 目标 的 状态 建 模 、 估 计 和 识别 。 目 标识 别 算法 
可 以 实现 预期 效果 ， 但 在 某 些 时 刻 由 于 目标 本 身 的 位 置 、 尺 寸 和 遮挡 等 偶发 状况 ， 以 及 环境 的 突然 变化 ， 可 能 导致 系统 出 现 目 标 虚 警 、 漏 检 甚 至 丢失 等 问 
题 。 同 时 由 于 采用 全 局 最 优 搜索 方法 ， 目 标识 别 算法 需要 大 量 的 时 间 开 销 和 计算 成 本 ， 这 和 系统 的 实时 性 要 求 相 矛盾 。 另 外 我 们 注意 到 ， 基 于 时 空 连续 性 
假设 的 目标 跟踪 算法 ， 以 历史 数据 为 先 验 知识 ， 采 用 局 部 最 优 搜索 方法 ， 只 对 目标 期 望 区 域 进行 跟踪 搜索 ， 搜 索 区 域 小 且 具 有 较 好 的 鲁 棒 性 和 较 低 的 计算 
消耗 。 针 对 上 述 问题 ， 本 节 提 出 一 种 新 的 多 目标 同时 识别 与 跟踪 方法 ， 该 方法 可 以 有 效 地 综合 利用 目标 识别 算法 的 全 局 最 优 性 和 目标 跟踪 算法 的 识别 鲁 棒 
性 ， 如 图 3-21 所 示 。 


” 心 跌 榨 测 心跳 检 沉 目标 跟 嗓 
只 别 与 跟踪 ( 周期 性 ) em (连续 性 ) 








视频 序列 
( 时 间 轴 ) 





状态 管理 发 现 新 目标 Obj3 


跟踪 目标 Obj1 0bj2 跟 叶 目标 Obj2 Obj3 


图 3-21 视频 流 中 多 目标 同时 识别 与 跟踪 方法 





和 以 往 研究 者 所 提出 的 万 法 不 同 ， 图 3-21 中 的 多 目标 同时 识别 与 跟踪 方法 将 识别 模块 和 跟 路 模块 集成 在 一 起 ， 综 合 利用 两 个 模块 的 优势 。 识 别 模块 在 
检测 周期 对 视频 帧 进行 全 局 检测 (本 节 称 之 为 心跳 检测 ) ， 并 将 检测 结果 用 于 目标 状态 管理 模块 。 跟 路 模块 负责 对 确认 存在 的 车 辆 目标 进行 精确 高 效 的 跟 


踩 。 


按照 模块 的 工作 逻辑 和 功能 ， 可 进一步 将 车 辆 识别 与 跟 路 系统 划分 为 三 个 模块 : 目标 识别 模块 、 多 目标 跟踪 模块 和 模式 状态 管理 模块 。 模 块 在 各 自 时 
间 尺度 下 有 序 工 作 ， 信 息 融 合 中心 对 各 模块 的 输出 结果 进行 分 析 和 融合 ， 给 出 最 终结 果 ， 如 图 3-22 所 示 。 


为 了 实现 对 单 帧 图 像 的 高 效 鲁 棒 识别 ， 在 目标 识别 模块 ， 本 节 提 出 路 面 约束 下 车辆 分 层级 联 识别 算法 ， 算 法 由 假设 产生 和 假设 检验 两 部 分 构成 。 在 假 
设 产 生 阶 段 ， 使 用 特征 窗口 漂移 算法 确定 路 面 特征 ， 获 得 当前 车 辆 所 在 位 置 的 路 面 区域 ， 并 将 后 续 搜索 范围 约 束 在 路 面 区 域 范围 之 内 。 在 假设 验证 阶段 ， 
提出 分 层级 联 搜 索 方法 ， 采 用 粗 搜索 和 精 搜 索 相 结合 的 方法 ， 实 现 目 标 千 辆 快速 鲁 棒 检 验 。 其 中 ， 粗 略 级 检测 算 子 采用 局 部 二 进 制 模型 〈Local Binary 
Pattern，LBP) 特征 ， 由 Discreat AdaBoost (DAB) 机 器 学 习 算法 训练 得 到 ， 精 密级 检测 算 子 采用 哈 尔 特 征 ， 由 Real AdaBoost (RAB) 方法 训练 得 


到 . 


在 目标 跟 中 模块 ， 本 节 引 入 序列 重要 性 采样 思想 ， 提 出 基于 粒子 滤波 的 车 辆 目标 跟踪 算法 ， 算 法 根据 跟踪 列表 中 各 目标 的 当前 状态 ,选择 性 地 对 目标 
进行 跟 趴 。 同 时 ， 跟 路 模块 还 将 目标 跟踪 结果 和 心跳 检测 结果 进行 融合 ， 实 时 更 新 目标 的 当前 状态 和 跟踪 模型 参数 ， 有 效 地 解决 了 目标 跟 路 系统 普遍 存在 
的 小 尺度 游荡 和 跟 路 并 后 问题 。 





目标 识别 言 恩 融合 中 心 多 目标 跟踪 


路 面 分 割 与 日 标 区 心中 识别 队 列 多 日 标 当前 模式 
二 锁定 4 ) 误 别 | : | 际 有 棋子 
或 铀 定 下 了 -TTT 确认 与 分 类 
二 LBP 特征 和 || ;全 ， 新 昌 标 存在 有 村 
DAB 级 联 分 类 规 的 


模式 决策 
HSV 空 间 目 标 特 
快速 识别 征 直方 图 与 粒子 初 
央 速 识别 系统 > 友 | 讼 化 
骨 棒 验证 = 2 林 畏 出 抬 化 

基于 哈 尔 特征 和 存在 目标 | 退出 目标 例如 
RAB 级 联 分 关 谷 的 Y 目标 状态 估计 与 
鲁 棒 识 别 系统 “生生 上 一 |【 重 采样 (循环 执行 ) 

中 中 队列 

模式 状态 管理 

状态 三 


ER 周期 性 目标 识别 结 
果 作为 心中 位 测 ， 使 





标 确认 上 人 目标 状态 />| 漏 入 | | 用 信任 计数 器 进行 模 


式 切 换 省 理 250ms 定 时 
错误 省 理 


状态 二 状态 四 





图 3-22 ”前 车 分 层级 联 识 别 与 跟踪 系统 框架 


考虑 到 粒子 滤波 算法 只 能 跟踪 给 定 目标 ， 无 法 处 理 多 目标 系统 中 目标 的 进入 和 消失 问题 ， 引 入 状态 信任 计数 器 构建 模式 状态 管理 模块 ， 将 目标 状态 分 
为 虚 警 、 目 标 确 认 、 漏 检 和 目标 退出 四 种 状态 ， 根 据 心 跳 检测 结果 对 目标 状态 进行 切换 。 


3.4.2 ”路 面 区 域 提 取 方 法 


在 正常 天 气 情况 下 ， 车 辆 在 道路 上 行驶 ， 和 车 辆 本 体 和 车 辆 阴影 会 占据 部 分 路 面 区 域 ， 映 射 到 图 像 中 此 规律 仍然 存在 ， 和 车 辆 只 可 能 出 现在 路 面 区 域 与 其 
他 区 域 相 接 的 位 置 。 利 用 这 一 先 验 知识 ， 在 获得 路 面 区 域 的 同时 ， 我 们 可 以 获得 感 兴趣 区 域 ， 为 后 续 车 辆 识别 与 跟踪 算法 做 好 准备 。 通 过 提取 视频 图 像 中 
的 路 面 区 域 ， 还 可 以 去 除 图 像 中 天 空 等 不 相 天 因素 对 识别 算法 的 干扰 。 


各 特征 点 提取 


城市 道路 具有 相同 或 相近 特征 ， 道 路 表面 的 不 同位 置 之 间 具有 关联 性 ， 并 且 明 显 区 别 于 非 路 面 区 域 。 利 用 这 一 知识 ， 首 先 使 用 路 面 特征 搜索 方法 获得 


Le ps He) 


路 面 特征 参数 ， 使 用 基于 灰 度 和 方差 的 相似 度 比较 方法 确定 特征 窗口 ， 获 得 当前 路 面 特 征 参数 。 路 面 特 征 窗口 搜索 方法 如 下 : 





图 3-23 ”路 面 特征 窗口 搜索 


(1) 在 图 像 下 边缘 处 随机 抽取 3 个 像素 为 20x20 的 特征 窗口 WI、W2、W3， 如 图 3-23 所 示 。 


2 
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(2) 特征 窗口 在 x 轴 方 向 以 offsetX 为 步 长 单位 进行 漂移 ，、 并 实时 计算 特征 窗口 方差 5<， 直 到 小 于 方差 阐 值 。 时 停止 搜索 。 如 果 x 轴 方向 搜索 失败 ， 
则 将 特征 窗口 沿 y 轴 向 上 平移 offsetY 个 单位 后 继续 在 x 轴 方 向 搜索 ， 直 到 搜索 成 功 。 特 征 窗口 在 调整 位 置 的 过 程 中 允许 碰撞 ， 但 不 能 重合 。 其 中 特征 窗口 方 
郑 用 如 下 变形 公 陈 计算 : 


a Nl 
2 ]  ，» 1 z : 
N i 三 心 N i = 
式 中 ，x 为 特征 窗口 内 像素 点 灰 度 值 ，N 为 窗口 内 像素 数目 ，a2 为 特征 窗口 方差 。 
(3) 特征 窗口 方差 在 先 验 范围 内 后 ， 计 算 各 特征 窗口 灰 度 值 ， 取 XW=min (X1，X2，X3) 为 特征 灰 度 ， 并 验证 XW 是 否 小 于 灰 度 先 验 阅 值 xth。 如 果 


(Fy Hy) 


验证 成 功 则 得 到 路 面 特征 参数 ，Hw 为 特征 窗口 灰 度 直方 图 ，'“ 为 特征 窗口 方差 ;否则 转 到 步骤 (1) 重新 启动 特征 窗口 搜索 。 


对 于 在 道路 上 行驶 的 车 辆 而 言 ， 车 辆 前 下 方 为 道路 的 可 能 性 最 大 ， 离 车 辆 越 远 ， 则 为 道路 的 可 能 性 越 小 。 在 图 像 平面 中 这 一 规律 表现 为 图 像 的 下 方 中 
点 处 为 路 面 的 可 能 性 最 大 ， 离 此 点 越 远 可 能 性 越 小 。 根 据 这 一 规律 生成 随机 点 集 ， 点 集 分 布 满足 如 下 二 维 高 斯 分 布 : 


(X,Y) ~ VOD oa aa yp) (3-41 ) 


» =w/2, p=h, 02 =w/2, 02 =h/2, p=0.5 


式 。 随 机 点 落 在 图 像 区 域内 的 为 有 效 点 ， 沙 人 在 图 像 区 域外 
的 被 舍弃 。 
2. 特 征 点 生长 与 路 面 获取 
不 是 所 有 随机 点 都 属于 道路 区 域 ， 还 需要 从 中 挑选 出 路 面 特征 点 ， 并 以 路 面 特征 点 为 基础 进行 目 生 长 操作 。 对 路 面 特征 点 的 挑选 采用 特征 匹配 方法 ， 
将 路 面 特征 点 处 的 图 像 特征 和 路 面 参考 特征 进行 相似 度 匹 配 ， 匹 配方 法 使 用 直方 图 相交 方法 。 
d(H,,H,) = ,min( H(i) ,H(i)) (3-42) 
i 


式 中 ，d 为 直方 图 匹配 系数 ， 高 分 表示 匹配 结果 较 好 ， 反 之 ， 低 分 表示 匹配 较 差 ，i 为 直方 图 bin 索 引 。 
匹配 过 程 完 成 后 ， 我 们 可 获得 路 面 特征 点 ， 以 此 作为 种 子 点 ， 开 始 种 子 点 目 生 长 操作 ， 如 图 3-24 所 示 。 该 过 程 主要 包括 以 下 四 个 步骤 : 


(1) 以 种 子 点 为 中 心 、r= 15 为 边 长 获取 单元 晶体 。 对 单元 晶体 区 域 属 于 路 面 区 域 的 可 信和 度 进行 评估 。 其 中 ， 可 信和 度 评 估 采 用 如 式 (3-42) 所 示 的 相 
似 度 匹配 方法 。 


(2) 根据 各 单元 晶体 的 可 信 度 评估 结果 扩大 该 种 子 点 的 生长 面积 ， 并 以 扩大 后 的 新 区 域 边 缘 像 素 为 新 种 子 点 ， 并 重复 步骤 (1) 的 评估 | 
(3) 当 各 种 子 点 周围 所 有 像素 和 相 邻 种 子 点 生长 区 域 相交 ， 或 者 种 子 点 无 法 继续 生长 时 ， 此 过 程 结束 。 


(4) 用 预先 设 定 的 颜色 标记 种 子 生 长 区 域 。 需 要 指出 的 是 ， 为 了 避免 冲突 和 干扰 ， 标 记 颜 色 应 使 用 路 面 不 常 使 用 的 颜色 ， 本 节 使 用 框 线 ( 见 图 3-24 
的 最 后 一 幅 图 ) 对 路 面 区 域 进行 标记 。 


会 弃 的 样本 点 











图 3-24 路面 区 域 自生 长 算法 


3.4.3 ”基于 机 器 学 习 的 车 辆 分 层级 联 识别 


和 传统 方法 不 同 ， 本 书 提出 一 种 基于 分 层级 联 识 别 的 车 辆 检测 新 算法 。 算 法 以 知识 学 习 万 法 为 基础 ， 同 时 考虑 了 多 种 类 型 车 辆 的 形状 和 纹理 特征 ， 使 
用 AdaBoost 分 类 器 对 大 量 车 辆 样本 进行 学 习 ， 获 取 车 辆 共性 特征 。 算 法 在 学 习 过 程 中 使 用 两 种 不 同 特征 提取 方法 ， 分 别 构造 检测 级 和 验证 级 双 层 分 类 器 ， 
实现 车 辆 的 分 层级 联 识别 。 


1. 检 测 级 分 类 器 训练 


在 初始 检测 阶段 ， 完 成 车 辆 目标 粗 搜 索 工 作 ， 即 在 保证 图 像 中 目标 漏 检 率 较 低 的 情况 下 ， 尽 量 提 遍 检测 级 搜索 速度 。 针 对 此 目标 ， 本 节 在 检测 级 使 用 
局 部 二 进 制 模式 (LBP) 提取 车 辆 纹理 特征 ， 并 使 用 DAB 机 器 学 习 算 法 对 获得 的 海量 LBP 特 征 进 行 训练 ， 获 得 检测 级 分 类 器 。 使 用 LBP 特 征 具 有 计算 消耗 
小 、 鉴 别 能 力 强 等 优点 ， 但 由 于 LBP 特 征 对 原 图 像 进行 局 部 二 进 制 化 操作 ， 信 息 丢失 严重 ， 因 此 得 到 的 检测 级 分 类 器 也 有 虚 警 率 较 高 的 缺点 。 


(1) 扩展 LBP 特 征 提取 。 对 传统 3x3LBP 邻 域 算 子 进行 扩展 ， 使 用 9x9LBP 令 域 算 子 提取 样本 车 辆 特征 。 考 虑 到 LBP 是 定义 在 灰 度 空间 中 的 纹理 描述 算 
子 ， 操 作 过 程 中 首先 需要 将 正 负 样本 从 RGB 图 像 空 间 转 损 到 灰 度 空间 ， 然 后 以 9x 9 像素 为 基本 操作 单元 ， 对 图 像 进 行 分 割 ， 舍 弃 无 法 构成 基本 操作 单元 的 
图 像 边缘。 这样， 图 像 纹理 T 便 可 以 使 用 基本 操作 单元 进行 定义 : 整个 窗口 由 1 个 中 心 窗口 gc 和 相 邻 的 8 个 3x3 像 素 的 子 窗口 go，.….，97 组 成 ， 如 式 (3- 
43) 所 元 。 


Te (OO ey 3. HF— Te) (3-43) 


扩展 后 的 9x 9 像素 基本 操作 单元 可 划分 为 9 个 3x 3 像素 子 窗 口 ， 分 别 求 取 9 个 子 窗口 的 灰 度 平 均值 ， 并 以 此 平均 值 代 蔡 原 有 的 3x 3 子 窗 口 。 通 过 此 简单 
运算 ， 一 方面 可 将 图 像 压 缩 为 原 图 像 的 1/9， 大 大 降低 后 续 算 法 的 计算 量 ; 另 一 方面 可 将 9x9LBP 邻 域 扩 展 算 子 变换 为 基本 3x3LBP 操 作 算 子 。 此 时 ， 图 像 
纹理 可 表示 为 : 


T - (8 Be," ,B87 2. ) (3-44) 


1 Or Cr 
ol ~ iel|0,7| (3-45) 
0 ， Bi = 2 


二 进 制 化 操作 后 的 图 像 纹理 特征 可 表示 为 : 


下 ~ (#( Fo 时 28.), 四 ,S( 87 一 8.)) (3-46) 


此 时 ， 基 本 操作 单元 可 以 使 用 8 个 二 进 制 数 来 表示 ， 使 用 式 (3-47) 对 像素 点 进行 加 权 求 和 处 理 ， 可 得 到 该 基本 单元 LBP 算 子 的 值 : 
7 
LBP(w,) = Ys(&, - &.)2 (3-47) 
i = 


LBP 特 征 值 描述 了 基本 操作 单元 局 部 区 域 的 纹理 特征 。 如 将 该 操作 方法 扩展 到 整个 样本 图 像 区 域 ， 则 可 得 到 样本 图 像 的 二 进 制 序列 接 述 和 和 LBP 特征 图 。 
通过 计算 LBP 特 征 图 的 直方 图 ， 可 对 样本 特征 进行 摘 述 ， 计 算 公 陈 为 : 


nl 


Hl. ,Tf(x,y) 一 7) 1 = Us | (3-48) 
i =0 


式 中 ，H 为 直方 图 ，n 为 直方 图 中 bin 的 数量 ,fi (x，y) 为 标记 的 图 像 ，1{ 人 } 的 定义 如 式 (3-49) 所 示 。 


i 
0， A 为 居 


Lf (3-49) 


LBP 特 征 可 以 对 图 像 的 边缘 、 纹 理 、 特 征 点 和 平面 区 域 进行 搞 述 ， 其 算法 具有 摘 述 简单 、 计 算 速 度 快 、 计 算 量 小 等 优 氮 。 


(2) 基于 DAB 算 法 的 分 类 器 训练 。 获 得 样本 集中 各 车 辆 的 LBP 特 征 后 ， 使 用 DAB 机 器 学 习 算法 对 海量 特征 进 ， 人 生成 误差 在 给 定 泡 围 内 的 弱 分 类 
器 。 


LBP 特 征集 中 的 任 一 特征 ， 都 对 应 一 个 分 量 分 类 器 ， 即 每 一 个 特征 fj 都 可 以 组 成 一 个 弱 分 类 器 hj (x) 。 


h(x) = ! pi\%) < pd 
0 其 他 


式 中 ，6 为 设 定 门限 值 ，p 为 奇偶 性 验证 因子 ，f (x) 为 LBP 特 征 ，h; (x) 为 获得 的 弱 分 类 器 。 


(3-50) 


使 用 LBP 特 征 构 造 弱 分 类 器 的 目的 是 组 建 一 个 检测 级 强 分 类 器 ， 因 此 还 需要 根据 预先 设 定 的 分 类 器 层 数 和 识别 误差 ， 
强 分 类 器 。 训 练 过 程 如 表 3-1 所 示 。 


训练 多 个 弱 分 类 器 ， 并 级 联 构建 


表 3-1 检测 级 分 类 器 训练 算法 
步骤 内 容 
(1) 给 定 入 个 分 布 为 D 的 样本 序列 | (x1, 71)，…，(xNw,， Yn)| 
输入 (2) WeakLearm- 旷 分 类 训练 算法 
ss 
初始 化 初始 化 权重 : w; = D(i)， » wi 


(1) 归 一 化 权重 py = -和 刀 


N 
Dw 
j=] 
(2) 调用 弱 分 类 和 代 法， 对 每 一 个 特征 
从 t=1 到 7 循环 | 类 如 满足 p 分 布 





训练 一 个 分 类 项 几 : X 一 [0，1], 分 


N 
(3) 计算 弱 分 类 器 误差 h: sa, = 了 pt |h(x; -yi) | 
下 


(4) 计算 B,=s,/(1 -6,) 
和 更 新 权重 为 w+ = wiB! Mi) -=i 





级 联 强 分 类 从 : 
I 1 1 
输出 ] (1o8 ) 2*) = 一 ”log 
hy(x) 二 名 ~» 2 名 ~» 
0 其 他 


在 分 类 器 训练 过 程 中 ， 首 先 计算 所 有 弱 分 类 器 的 错 分 误 震 ， 根 据 误 才 大 小 将 其 中 具有 最 小 分 类 误差 的 分 类 器 挑选 出 来 ， 并 将 其 作为 第 一 级 弱 分 类 器 。 
然后 ， 对 样本 权重 进行 更 新 ， 并 重新 计算 弱 分 类 器 的 错 分 误差 ， 重 新 根据 误差 量 确定 下 一 级 分 量 分 类 器 ， 如 此 迭代 循环 ， 可 以 完成 要 求 层级 的 弱 分 类 器 构 
建 。 将 分 类 器 堵 加 后 ， 获 得 强 分 类 器 。 


DAB 机 器 学 习 算 法 通过 对 大 量 车 辆 样本 进行 训练 ， 从 中 挑选 出 一 组 最 具 共 性 和 鉴别 能 力 的 LBP 特 征 ， 并 以 此 特征 分 量 分 类 


分 量 分 类 器 为 基础 ， 构 建 相应 弱 分 类 


分 类 器 ， 检 测 级 分 类 器 训练 过 程 如 图 3-25 所 示 。 
分 类 器 具有 较 低 的 漏 检 率 ， 但 对 虚 警 率 不 做 要 求 。 为 了 满足 上 述 要 


器 。 然 后 ， 对 弱 分 类 进行 级 联 ， 组 成 一 个 检测 级 强 
在 粗 搜索 阶段 ， 检 测 级 分 类 器 在 保证 识别 算法 高 效 快 速 运行 的 同时 ， 还 需要 保证 
分 类 器 来 构建 检测 级 强 分 类 器 ， 本 蔬 使 用 四 层 弱 分 类 器 。 


刀 大 刀 大 


到 


求 ， 可 使 用 较 少 层级 的 弱 
2. 验 证 级 分 类 器 训练 
器 具有 目标 识别 速度 快 、 漏 检 率 低 等 优点 ， 但 由 于 其 分 类 也 这 来 目标 虚 警 率 高 等 问题 。 


器 包含 较 少 层级 的 弱 分 类 器 ， 


正如 前 面 所 述 ， 检 测 级 分 


人 类 昌 
此 ,， 在 目标 验证 级 检测 阶段 ， 还 需要 使 用 精 搜 索 算法 对 候选 车 辆 目标 进行 进一步 验证 ， 去 除 其 中 的 虚 警 目标 ， 获 得 更 为 准确 的 识别 结果 。 


基于 LBP 特 征 的 检测 级 分 类 器 训练 





LBP 特 征 搞 述 算 子 





DAB 训 练 
车 辆 假充 





视频 图 像 


厅 列 


非 车 辆 


基于 LBP 特 征 和 DAB 算 法 的 检测 级 分 类 器 训练 





韭 车 辆 





图 3-25 
在 精 搜索 阶段 ， 使 用 哈 尔 特 征 提取 车 辆 轮廓 与 纹理 特征 ， 借 助 RAB 机 器 学 习 算法 对 得 到 的 哈 尔 特征 进行 训练 ， 构 建 验证 级 分 类 器 。 使 用 哈 尔 特 征 ， 具 
有 识别 准确 度 高 、 鲁 棒 性 好 等 优点 ， 但 相 比 检测 级 LBP 特 征 而 言 ， 哈 尔 特征 的 计算 复杂 度 较 高 ， 耗 时 较 长 。 
特征 最 早 由 帕 帕 吉 奥 吉 欧 (Papageorgiou) 等 人 提出 ， 并 将 其 应 用 于 人 脸 特 征 描 述 和 检测 算法 ， 其 后 Viola 等 人 对 该 方法 进 


(1) 哈 尔 特征 提取 。 哈 尔 和 
行 了 补充 和 扩展 | ”|。 本 节 使 用 4 种 类 型 ， 共 6 种 哈 尔 特征 组 成 特征 模板 ， 对 车 辆 目标 进行 边缘 和 纹理 特征 描述 ， 特 征 模板 中 包括 2 种 边缘 特征 、2 种 线性 特 


征 、1 种 对 角 特征 和 1 种 中 心 特征 ， 如 图 3-26 所 示 。 


边 绿 特征 线性 特征 对 角 特 征 ”中 心 特征 


(a) (b) (c) (d) 


i .OO 








图 3-26 ”车 辆 样本 哈 尔 特征 提取 


将 哈 尔 特征 定义 为 黑 日 相间 的 矩形 分 割 ， 可 以 使 用 图 像 中 相 邻 矩形 区 域内 的 灰 度 牵 来 量化 表达 ， 即 使 用 图 像 中 日 色 和 矩 形 像素 和 减 去 黑色 和 矩形 像素 和 |， 
如 式 (3-51) 所 示 。 为 了 更 好 地 提取 图 像 特征 ， 本 节 首 先 对 样本 图 像 进 行 灰 度 化 和 直方 图 均衡 化 处 理 。 


f(1) = VR Sum( A, ) (3-51) 


m=] 


式 中 ，N 为 样本 图 像 | 中 哈 尔 特征 的 数量 ，m 为 哈 尔 特 征 达 引 标识 ，Am 为 算 形 区 域 ，R 为 旋转 因子 ，Cm 为 特征 值 ， 当 像素 灰 度 为 黑色 时 Cm 为 0， 为 日 色 
时 Cm 为 1。 


对 于 32x32 像 素 的 王 辆 样本 而 言 ， 单 个 样本 图 像 内 特征 模板 数量 有 近 万 个 。 因 此 ， 在 实际 操作 过 程 中 还 需要 借助 积分 图 来 加 快 算法 处 理 速 度 。 


在 积分 图 计算 过 程 中 ， 首 先 求 取 从 图 像 左 上 角 起 点 开始 到 其 余 各 后 所 形成 的 算 形 区 域 像素 和 ， 并 将 像素 和 以 数组 元 素 的 形式 保存 在 内 存 中 。 在 求解 如 
式 (3-52) 所 示 的 特征 值 时 ， 可 通过 快速 索引 法 获取 像素 票 加 和 ， 提 高 计算 效率 。 积 分 图 计算 万 法 如 陈 (3-52) 所 示 。 


i(i) = $A,D) (3-52) 


式 中 ,ii (i, j) 为 积分 图 中 (i, j) 点 积 分 值 , f(k,1) 为 原 图 中 (i, j) 点 左上 角 任 一 点 像素 值 。 积 分 图 是 一 种 能 够 摘 述 全 局 信息 的 和 矩阵 表示 方法 ， 
一 次 扫 摘 便 可 以 完成 图 像 积 分 图 的 构建 . 


(2) 基于 RAB 方 法 的 分 类 器 训练 。 和 检测 级 分 类 算法 相同 ， 在 获得 样本 哈 尔 特征 后 ， 还 需要 借助 RAB 机 器 学 习 算 法 ， 对 获得 的 哈 尔 特征 进行 训练 ， 并 
使 用 获得 的 弱 分 类 器 进行 级 联 操作 ， 生 成 验证 级 强 分 类 器 。 


和 检测 级 不 同 的 是 ， 在 检测 级 分 类 器 训练 过 程 中 ，DAB 学 习 算 法 将 弱 分 类 器 输出 值 限定 为 (-1，+1) 两 种 模式 ， 因 此 弱 分 类 器 只 能 对 目标 识别 结果 做 出 
是 和 非 两 种 判断 ; 而 在 验证 级 分 类 器 训练 过 程 中 ，RAB 机 器 学 习 算法 将 弱 分 类 器 输出 学 围 扩展 到 整个 实数 区 间 。 从 实质 上 讲 ， 从 DAB 学 习 算 法 到 RAB 学 习 


算法 是 古典 集合 到 模糊 集合 的 转变 ， 将 目标 识别 结果 区 分 为 是 、 不 是 和 可 能 是 等 多 种 带 有 权重 的 判断 结果 ， 输 出 结果 更 具 鲁 棒 性 ， 验 证 级 分 类 器 如 式 (3- 
53) 所 元。 


H(x) = sign | yah (x) | (3-53) 


式 中 ，H (x) 为 验证 级 强 分 类 器 ，ht (x) 为 弱 分 类 器 ，ht (x) ER 为 判断 结果 的 可 信 度 ，ct/ 弱 分 类 器 ht (x) 的 权重 ，T 为 弱 分 类 器 的 数量 ，t 为 弱 


分 类 器 索引 标识 ，sign (.) 定义 如 下 : 


加 及 > ah, (x) 二 Sp ， 
sign(.) = 2 | (3-54) 


v; 其 他 


一 


0 ;i V; ee ee Tg _ 
式 中 ，sth 为 信任 阅 值 ， ! 表示 分 类 器 输出 结果 为 真 ， 表示 分 类 器 输出 结果 为 假 。 验 证 级 分 类 器 训练 过 程 如 表 3-2 所 示 。 
表 3-2 ”验证 级 分 类 器 训练 算法 


(1) 给 定 入 个 的 样本 序列 {x1 ,71),，…， (xw, Yn)}, Xx: EX, yeY:= 


二 
人 | -1，+1| 
初始 化 初始 化 权重 : ww =D(i)=1l/m, i=l1, “NN 


(1) 获得 样本 权重 忆 

(2) 训练 罚 分 类 和 侣 hh: X 一 R 

(3) 计算 a,eR 
从 :=1 到 了 循环 (4) 更 新 权重 : 
D,(i)exp| 一 oyih,(x,) 
pi) = Co 
式 中 ，Z, 为 正则 化 因子 
级 联 强 分 类 从 为 : 


ft LD 4: 
输出 H(x) 一 sn Dah x) 


t=] 


验证 级 分 类 器 的 训练 过 程 如 图 3-27 所 示 。RAB 学 习 算 法 根据 预定 误差 和 训练 层 数 对 输入 样本 集 进行 训练 ， 可 获得 一 组 弱 分 类 器 ， 然 后 通过 对 弱 分 类 器 
的 级 联 操 作 ， 最 终生 成 验证 级 强 分 类 器 。 

如 前 所 述 ， 验 证 级 分 类 器 需要 对 候选 目标 进行 进一步 确认 ， 保 证 最 终 识 别 结果 的 可 信和 度 。 如 图 3-27 所 示 ， 本 证 在 验证 级 使 用 8 级 弱 分 类 器 ， 来 构建 验 
证 级 强 分 类 器 ， 在 目标 识别 可 信和 度 得 到 有 效 保证 的 同时 ， 将 算法 计算 消耗 控制 在 系统 可 承受 的 学 围 内 。 


3. 车 辆 目标 识别 过 程 


根据 前 文 所 述 ， 车 辆 识别 模块 包括 道路 区 域 分 割 、 车 辆 目标 检测 和 车 辆 目标 验证 三 部 分 ， 算 法 在 前 文中 已 做 详细 介绍 。 其 中 ， 在 获得 车 辆 检测 级 和 验 
证 级 分 类 器 后 ， 需 要 根据 样本 集 参 数 ， 使 用 图 像 变 换 方 法 对 待 识别 图 像 进 行 预 处 理 。 


基于 哈 尔 特 征 的 验证 级 分 类 硕 训 练 


边缘 特征 ”线性 特征 对 角 特 征 中 心 特征 
(a bea i) 


Le 





图 3-27 ”基于 哈 尔 特征 和 RAB 章 法 的 验证 级 分 类 器 训练 


车 辆 分 类 器 由 样本 集训 练 得 到 ， 训 | 练 过 程 中 机 器 学 习 算 法 将 样本 归 一 化 到 预定 尺寸 (本 节 设 为 32x32 像 素 ) 。 这 意味 着 ， 在 实际 车 辆 识别 系统 中 ， 车 
辆 检测 级 和 验证 级 分 类 器 只 能 够 对 图 像 中 是 否 存 在 32x 32 像 素 大 小 的 车 辆 目标 进行 识别 。 因 此 ， 在 识别 过 程 中 还 需要 对 图 像 进行 缩放 操作 ， 将 不 同 远近 的 
车 辆 缩放 到 和 车 辆 分 类 器 可 识别 的 范围 内 ， 本 节 使 用 高 斯 图 像 金字 塔 来 完成 这 一 操作 。 


高 斯 核 作 为 线性 尺度 变换 核 ， 能 够 满足 平移 不 变性 、 尺 度 不 变性 和 旋转 不 变性 等 性 质 。 高 斯 金字 塔 采用 下 采样 方法 : 首先 使 用 高 斯 核对 输入 图 像 进行 
卷 积 处 理 ， 然 后 删除 图 像 中 所 有 偶数 行 和 偶数 询 ， 直 到 达到 设 定 中 止 条 件 时 ， 停 止 降 采 样 ， 得 到 一 系列 尺寸 缩放 的 图 像 集 。 


如 图 3-28 所 示 ， 在 车 辆 检测 级 识别 阶段 ， 图 像 金 字 塔 分 割 输入 为 路 面 区 域 分 割 后 生成 的 ROI 区 域 ; 而 在 车 辆 验证 级 识别 阶段 ， 图 像 金 字 塔 分 割 输入 为 
检测 级 目标 识别 的 输出 结果 。 


3.4.4 ”基于 粒子 滤波 的 多 目标 跟踪 


城市 环境 中 的 和 车辆 种 类 众多 ， 视 频 图 像 育 景 复 杂 多 样 ， 当 目标 被 遮挡 等 情况 友 生 时 ， 容 易 导 致 识别 算法 出 现 虚 警 或 漏 检 等 问题 。 因 此 ， 为 了 保证 系统 
的 鲁 棒 性 ， 仪 仪 使 用 车 辆 检测 算法 是 不 够 的 。 本 节 在 车 辆 跟 踩 阶段 ， 提 出 基于 粒子 滤波 的 多 目标 跟 踩 算法， 在 HSV 空 间 使 用 车 辆 颜色 特性 从 局 部 最 优 的 角 
度 实 现 车 辆 目标 的 稳定 、 快 速 跟 踩 。 


输入 图 像 路 面 区域 分 割 与 标记 
(ROI 产 生 ) 


检测 级 金字 塔 分 割 输入 


检测 级 目标 结果 输出 


新 目标 识别 算法 输出 结果 





图 3-28 ”视频 车 辆 目标 识别 过 程 


粒子 滤波 器 通过 从 后 验 概率 中 抽取 随机 状态 粒子 来 表达 其 分 布 ， 能 够 比较 精确 地 表达 基于 观测 量 和 控制 量 的 后 验 概率 分 布 ， 是 一 种 顺序 重要 性 采样 
法 ， 在 车 辆 目标 跟踪 系统 应 用 中 具有 优越 性 。 但 是 使 用 粒子 滤波 算法 对 多 目标 进行 跟 踩 ， 也 面临 如 下 困难 : 


(1) 粒子 滤波 算法 只 能 同时 对 单一 目标 进行 建 模 和 估计 ， 不 能 改变 跟踪 过 程 中 跟 踊 对 象 的 数量 ， 对 于 多 目标 跟 路 系统 而 言 需要 改进 。 
(2) 粒子 滤波 算法 可 以 处 理 车 辆 目标 的 漏 检 问题 ， 但 是 无 法 处 理 虚 警 问题 和 车 辆 进入 、 驶 出 视野 时 的 跟 踩 问题 。 
(3) 粒子 滤波 跟 踩 系统 仓 在 累积 误差 ， 长 时 间 工作 容易 上 友 生 小 尺度 游荡 和 跟踪 滞后 问题 。 


针对 上 述 问 题 ， 我 们 提出 一 种 新 的 多 目标 状态 管理 算法 ， 为 图 像 中 每 个 目标 分 配 一 个 目标 状态 管理 器 ， 设 定 目标 具有 目标 虚 警 、 目 标 确认 、 目 标 漏 检 
和 目标 丢失 等 四 种 状态 。 目 标 状态 管理 模块 一 方面 通过 对 跟踪 队列 中 各 目标 状态 信任 度 进行 监控 ， 来 解决 多 车 辆 目标 进入 和 驶 出 摄像 机 视野 的 问题 ; 另 一 
方面 通过 对 多 和 车辆 目标 进行 分 别 建 模 ， 来 解决 多 目标 同时 跟踪 的 问题 。 同 时 ， 目 标 状态 管理 模块 还 综合 利用 目标 识别 模块 的 全 局 最 优 结 果 和 跟踪 模块 的 局 
部 最 优 结果 ， 来 解决 跟踪 系统 误差 累积 和 尺度 游荡 的 问题 。 

在 同时 检测 和 跟踪 的 过 程 中 ， 目 标识 别 模 块 使 用 心跳 检测 方法 ， 对 整 幅 图 像 进行 周期 性 检测 ， 并 在 目标 状态 管理 模块 中 ， 将 结果 与 跟踪 模块 对 同一 目 
标的 跟踪 结果 相 比 较 ， 更 新 车 辆 信任 计数 器 。 为 了 保证 跟踪 系统 的 可 信和 度 ， 粒 子 渡 波 跟踪 系统 只 对 状态 为 确认 人 态 和 漏 检 仿 的 目标 进行 跟踪 ， 车 辆 信任 计数 
器 及 目标 状态 管理 过 程 如 图 3-29 所 示 。 


序列 图 像 目标 状态 管理 
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心跳 检测 周期 
图 3-29 ”车 辆 信任 计数 器 及 目标 状态 管理 过 程 


粒子 滤波 跟踪 系统 可 以 很 好 地 弥补 识别 系统 存在 的 不 足 ， 解 决 模块 存在 的 虚 警 和 漏 检 问 题 ， 并 通过 对 目标 状态 的 管理 来 保证 系统 的 鲁 棒 性 。 目 标 状 态 
管理 过 程 如 下 : 


(1) 目标 状态 管理 模块 从 车 辆 目标 进入 图 像 时 刻 开始 ， 对 其 进行 管理 。 新 目标 出 现时 ， 系 统 首 先 假设 其 为 系统 虚 警 导致 的 错误 ， 并 假设 其 目标 状态 为 
虚 警 态 ， 初 始 化 对 应 的 目标 信任 计数 器 计数 值 C-ount 值 为 Sfalse。 


(2) 在 后 续 心跳 检测 周期 中 ， 识 别 模 块 继续 对 虚 警 态 目标 进行 监控 ， 并 根据 监控 结果 实时 调整 目标 信任 计数 器 值 。 如 果 在 后 续 心跳 检测 周期 中 ， 目 标 
仍然 存在 ， 则 信任 计数 器 计数 值 加 1， 否 则 信任 计数 器 计数 值 减 1。 

(3) 当 信 任 计数 器 计数 值 Ccount 增 加 到 Sconf 后 ， 调 整 对 应 目标 状态 为 目标 确认 态 。 此 时 ， 如 果 后 续 心跳 检测 周期 中 目标 仍然 存在 ， 则 Ccouni 继 续 增 
长 ， 直 到 达到 计数 上 限 Ccth 时 停止 ， 如 果 后 续 心跳 检测 周期 中 目标 丢失 ， 则 Ccount 将 会 下 降 ， 当 降低 到 Sund 时 ， 调 整 对 应 目标 状态 为 目标 漏 检 态 ， 当 继续 
下 降 到 Sunexit 后 ， 调 整 对 应 目标 状态 为 目标 委 失 态 ， 直 至 计数 值 减少 到 下 限 Cdth 后 停止 。 此 时 系统 认定 目标 已 经 离开 视野 ， 回 收 状态 管理 模块 所 占据 的 内 
存 空间 和 系统 资源 . 


(4) 为 了 保证 跟踪 算法 的 有 效 运行 ， 粒 子 滤波 跟踪 系统 只 对 状态 为 目标 确认 态 和 目标 漏 检 访 的 目标 进行 跟踪 ， 并 将 跟踪 结果 和 识别 结果 进行 对 比分 
析 ， 实 时 调整 跟踪 参数 ,消除 系统 囚 积 误 和 牵 ， 从 而 解决 跟踪 模块 的 尺度 游 蕊 问题 。 


2. 粒 子 滤波 与 目标 跟踪 


粒子 滤波 通过 寻找 一 组 在 状态 空间 中 传播 的 随机 样本 ， 对 概率 密度 冰 数 p (xk|zk) 进行 近似 处 理 ， 以 样本 均值 代 茶 积分 运算 ， 从 而 获得 状态 的 最 小 方 
笑 估 计 。 本 书 首先 将 图 像 从 RGB 空间 转换 到 HSV 空 间 ， 在 HSV 空 间 中 建立 目标 的 头 色 特征 参考 模型 ， 采 用 随机 生成 的 可 缩放 粒子 集 来 估计 目标 的 概率 密度 
浮 数 ， 通 过 重 采 样 方法 来 解决 粒子 退化 问题 ， 获 得 对 车 辆 目标 的 最 优 估计 。 


x 


(1) 粒子 初始 化 。 定 义 粒 子 为 可 缩放 矩形 ， 建立 待 跟踪 目标 的 动态 模型 i ， 动 态 模型 包括 当前 目标 的 位 置 、 缩 放 系数 和 参考 颜色 直方 图 信息 ， 如 
式 (3-55) 所 示 。 


1 加 本 本 机 Ni Ee {1,.…,M | (3-55) 


， m 


;Wh ss 
式 中 ，M 为 t 时 刻 跟踪 列表 中 待 跟 踊 目标 车 辆 数目 ，| 为 粒子 集 索 引 序 号 ， a 表示 某 个 粒子 中 心 在 图 像 平面 中 的 位 置 ， “*" 表示 t 时 刻 粒子 的 缩放 系 


m 
ey 
数 ， “"' 表示 粒子 集 的 参考 颜色 直方 图 信息 。 
在 初始 化 阶段 ， 还 需 定 义 目标 所 拥有 的 粒子 数量 N。 从 跟 路 效果 的 角度 来 讲 ， 目 标 所 拥有 的 粒子 数 N 越 大 ， 目 标 状 态 概 率 密度 函数 p (xk | zk) 的 近似 
度 越 高 ， 滤 波 跟踪 效果 越 好 。 但 在 We 系统 所 需 计 算 负 载 越 大 ， 算 法 实时 性 越 差 。 由 于 本 节 使 用 了 同时 识别 和 跟踪 方法 ， 在 每 一 次 心跳 检测 阶 
段 ， 都 会 对 粒子 参考 颜色 特征 蛋 型 型 “ni 进行 更 新 ， 因 此 即使 在 粒子 数 N 较 小 时 ， 仍 能 获得 较 好 的 跟踪 效果 ， 本 书 中 N 取 50， 


(2) 传播 异型。 在 图 像 平面 中 ， 相 邻 图 像 间 车 辆 目标 的 位 置 不 会 友 生 转变 。 因 此 ， 车 辆 目标 位 置 更 新 过 程 可 以 用 状态 转移 方程 来 估计 。 根 据 历史 位 置 
信息 ， 采 用 二 次 目 回归 模型 来 估计 当前 车 辆 的 位 置信 息 ， 如 式 (3-56) 所 示 。 


Xt=A1Xt 一 1+TA2XtL 一 2 十 B :N (0, A) (3-56) 
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式 中 ， ”| ”， 为 t 时 刻 图 像 中 的 粒子 状态 ，“”“*”““' 为 粒子 中 心 所 在 的 位 置 坐 标 ， “为 比例 缩放 因子 。A1、A2 和 B 为 各 项 系 


数 ， 本 书 中 取 A1=2.0，A2= - 1.0，B=1.0。N (0，A) 服从 均值 为 0 的 高 斯 分 布 ， 
A = diag(o’, es 0: ) ，o” =1.0, OT， =0.5, o, =0.01 
(3) 粒子 可 信 度 计算 。 使 用 颜色 直方 图 特征 描述 方法 描述 目标 特征 具有 众多 优点 ， 特 别 是 待 识别 目标 发 生 旋 转 、 缩 放 、 遮 挡 时 ， 颜 色 直方 图 特征 描述 


方法 仍 能 保持 良好 的 稳定 性 。 但 单纯 的 颜色 摘 述 方法 对 光照 变化 敏感 ， 为 此 本 节 在 颜色 直方 图 中 加 入 饱和 度 和 亮度 信息 ， 综 合 利用 HSV 空 间 中 3 个 独立 通道 
言 妃 ， 构 建 联合 颜色 直方 图 表示 方法 ， 保 证 系统 的 鲁 棒 性 。 


为 了 便于 计算 ， 联 合 颜色 直方 图 采用 归 一 化 方法 构建 ， 直 方 图 共 包括 NB=NHxNS+NV 个 bin (本 书 中 取 NH=NSs=Nv=9) ， 如 陈 (3-57) 所 示 。 


1 全 


5 g(n,x,) 一 ( 3-57) 


ri 


分 别 计算 各 像素 点 的 颜色 、 饱 和 度 和 亮度 三 个 特征 ， 挑 选 其 中 最 有 代表 性 的 特征 统计 a 到 直方 图 中 。 在 具体 操作 过 程 中 ， 首 先 将 图 像 中 饱和 度 和 亮度 像 
Vs =0. 18 J = 0. 25 


素 较 高 的 点 (饱和 度 大 于 和 像素 亮度 值 大 于 “ 的 像素 点 ) 统计 到 前 NHxNs 个 bin 中 ， 而 将 其 余 点 统计 到 后 Nvy 个 bin 中 。 


为 了 构建 粒子 的 可 信和 度 系数 ， 还 需 建立 参考 目标 直方 图 。 参 考 目标 直方 图 由 心跳 检测 阶段 、 目 标识 别 模块 输出 结果 、 目 标 跟 踪 模 块 输出 结果 和 目标 历 
史 信 息 共 同 决 定 ， 并 使 用 式 (3-58) 对 其 进行 融合 。 


Xt=0 .4Dr+0 .4Tt+0 .2Xt—1 (3-58 ) 


式 中 ，Dt 为 目标 识别 模块 输出 结果 ，Tt 为 目标 跟 中 模块 输出 结果 ，Xt - 1 为 前 一 时 刻 目 标 所 在 位 置信 息 。 以 融合 后 的 Xt 为 目标 当前 位 置 ， 建 立 目标 参考 
联合 颜色 直方 图 ， 如 式 (3-59) 所 示 。 


1 


多 (na ) = 1] (3-59) 


志和 | 
同时 引入 巴特 查 里 亚 (Bhattacharyya) 系数 作为 各 粒子 与 参考 联合 颜色 直方 图 | 介 可 信和 度 的 评价 指标 ， 如 式 (3-60) 所 示 。 


Ny B 


qd (at) =1- > /gq(n,%,) X 9 (n,%,) (3-60) 


n=] 
式 中 ，Nb 为 直方 图 中 bin 的 数量 ，xt 为 跟踪 过 程 中 的 各 粒子 所 在 位 置 图 像 ，x0 为 参考 目标 图 像 ，d“ (xt，x0) 为 两 个 图 像 直方 图 的 巴特 查 里 亚 系数 。 
因此 ， 粒 子 的 权重 可 通过 计算 巴特 查 里 亚 系 数 指数 次 大 的 方法 来 构建 ， 如 陈 (3-61) 所 示 。 
p (zt | xt) ~exp [一 Xdq< (xt，x0) ] (3-61) 
式 中 ， 入 为 距离 因子 ， 本 节 取 入 =18，p (zt|xt) 为 粒子 权重 。 粒 子 可 信 度 越 高 ， 权 重 越 大 ， 否 则 权重 越 小 。 
(4) 粒子 重 采样 。 在 目标 跟 踩 过 程 中 ， 部 分 粒子 会 因为 权重 过 小 而 发 生 衰退 ， 为 了 维持 粒子 数量 和 跟踪 算法 的 持续 性 ， 还 需要 引入 重 采 样 方法 。 


粒子 重 米 样 过 程 从 本 质 上 来 讲 ， 是 一 个 舍弃 权重 过 小 粒子 ， 而 保留 并 分 裂 权重 较 大 粒子 的 过 程 。 首 先 根据 权重 对 粒子 进行 排序 ， 舍 茎 权重 为 后 30% 的 
粒子 ， 保 留 前 70% 的 粒子 ， 然 后 对 权重 最 大 的 30% 的 粒子 进行 重 采样 操作 ， 重 采样 公式 如 了 式 (3-62) 所 示 。 


P(T = xi) = wi (3-62) 


***_In 
"为 采样 前 的 权重 粒子 集 ， ” “为 重 采 样 后 的 粒子 集 ，m 为 重 采 样 的 粒子 个 数 。 
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a ) 部 分 正 样本 图 像 





b ) 部 分 负 样 本 图 像 


图 3-30 “部 分 样本 集 图 像 


测试 图 像 来 自 车 载 视 频 系 统 采集 的 长 沙市 内 交通 场景 视频 ， 摄 像 机 频率 为 25 帧 / 秒 。 算 法 程序 及 用 VC2005 平 台 开 发 ， 运 行 环境 为 Windows XP 系 统 ， 


处 理 器 为 Intel Pentium， 主 频 为 2.2GHz， 内 存 为 2G。 


车 辆 分 类 器 训练 时 需要 使 用 样本 集 ， 样 本 集中 包括 两 种 类 型 的 样本 : 正 样本 和 人 负 样 本 。 车 辆 正 样本 集 包括 1276 张 独立 的 车 辆 后 部 和 侧 后 部 图 片 ， 每 张 
正 样本 都 家 预先 裁剪 为 32x 32 像 素 大 小 ， 并 在 配置 文件 中 给 出 车 辆 在 图 片 中 的 位 置 ， 正 样本 如 图 3-30a 所 示 。 和 车辆 负 样 本 集 包 括 2234 张 容易 引起 误 检测 的 
图 像 ， 负 样本 集中 的 图 像 大 小 没有 限定 ， 如 图 3-30b 所 示 。 


使 用 样本 集训 练 出 分 类 器 之 后 ， 还 需要 使 用 测试 集 评估 分 类 器 对 实际 车 辆 目标 的 识别 性 能 。 本 书 测 试 集 由 车 载 摄 像 机 扣 报 ， 共 包括 8 个 视频 片段 、 
75082 帧 图 像 。 测 试 视频 不 仪 包括 不 同时 间 段 的 城市 交通 ， 还 包括 阴雨 等 天 气 时 扣 报 的 高 速 公路 、 乡 村 公路 等 不 同 环境 。 


2. 算 法 测试 与 分 析 


图 3-31 展 示 了 使 用 路 面 区 域 分 割 算法 的 优势 。 通 过 对 路 面 区 域 的 分 割 和 提取 ， 一 万 面 可 以 获得 后 续 车 辆 识别 模块 的 感 兴趣 区 域 ， 减 少 计算 量 ， 提 高 实 
时 性 ; 另 一 方面 可 以 去 除 大 部 分 环境 背景 对 后 续 算法 的 干扰 ， 提 高 识别 算法 鲁 棒 性 。 





a ) 前 方 只 有 一 辆 车 b ) 前 方 多 辆 车 同时 出 现 
图 3-31 路 面 区 域 分 割 结果 


图 3-32 展 示 了 和 车辆 同时 识别 和 跟踪 算法 的 优势 。 在 心跳 检测 阶段 ， 算 法 同时 使 用 识别 与 跟踪 方法 ， 对 同一 帧 图 像 中 的 车 辆 目标 进行 检测 ， 并 在 目标 状 
态 管理 模块 中 ， 将 识别 结果 和 跟 踩 结果 进行 融合 ， 一 方面 融合 可 以 获得 可 信 度 更 高 的 输出 ， 另 一 方面 利用 此 融合 结果 更 新 粒子 参考 模型 ， 可 以 使 后 续 跟 踩 
结果 更 具 可 信和 度 。 





a ) 某 图 像 帆 车 辆 识 剂 结 b ) 某 图 像 帧 车 辆 跟踪 结 


图 3-32 ”同时 识别 和 跟踪 算法 


图 3-33 展 示 了 和 车辆 识别 算法 和 跟踪 算法 的 互补 作用 。 在 某 心跳 检测 时 刻 ， 由 于 距离 等 原因 ， 和 车 辆 识别 算法 出 现 漏 检 ， 识 别 算法 只 成 功 检测 出 车 辆 前 方 
三 辆 车 中 的 两 辆 ， 遗 漏 了 距 本 车 最 远 的 一 辆 。 此 时 ， 因 为 车 辆 跟 路 算法 利用 了 视频 图 像 的 时 空 关联 性 知识 ， 粒 子 渡 波 算法 仍然 对 车 辆 进行 跟 路 。 








a ) 车 辆 册 询 结 未 b ) 车 辆 跟 足 结 琳 


图 3-33 ”识别 算法 和 跟踪 算法 的 互补 作用 


图 3-34 展 示 了 不 同 天 气 情况 下 ， 多 目标 车 辆 的 检测 结果 。 在 图 3-34a 所 展示 的 晴朗 天 气 情 况 下 ， 算 法 很 好 地 检测 到 了 前 方 全 部 车 辆 目标 。 但 在 图 3-34b 
所 展示 的 阴雨 天 气 中 ， 由 于 距离 和 天 气 所 市 来 的 光绪 变化 和 车 辆 污染 ， 算 法 出 现 了 漏 检 错误 ， 有 辆 车 没有 被 正确 地 识别 出 来 。 





a) 晴 朋 天 气 时 交通 局 峰 b ) 阴雨 天 气 时 交通 高 峰 


图 3-34 不 同 天 气 下 多 目标 车 辆 检测 结果 


图 3-35 展 示 了 算法 对 不 同类 型 、 颜 色 和 形状 车 辆 的 识别 结果 。 算 法 采用 的 测试 视频 集中 共 包含 120 台 不 同 千 辆 ， 尽 管 车 辆 类 型 各 不 相同 ， 本 节 算 法 仍 
能 取得 比较 理想 的 效果 。 


3. 测 试 结果 统计 


将 测试 集 分 为 天 气 较 好 和 较 大 两 种 情况 ， 分 别 进行 统计 。 晴 朗 天 气 中 光线 充足 ,场景 能 见 度 高 ， 和 车辆 轮廓 清晰 ， 算 法 的 识别 正确 率 达 到 91.2%。 但 是 
在 阴雨 等 较 差 天 气 环境 中 ， 由 于 污染 、 天 和气 能 见 度 下 降 等 原因 ， 算 法 识别 的 正确 率 下 降 到 85% ~ 90%。 


本 





b ) 一 辆 卡车 和 一 辆 轿车 





c ) 一 辆 特殊 车 辆 和 一 辆 SUV d ) 两 辆 小 型 面包 车 


图 3-35 不 同类 型 车 辆 的 识别 结果 


本 节 在 不 同 模块 中 使 用 不 同 颜色 空间 ， 在 路 面 分 割 模块 中 使 用 RGB 颜 色 信息 提取 路 面 特征 ;而 在 车 辆 识别 模块 中 ， 为 了 提高 算法 效率 ， 及 用 灰 度 颜色 
空间 ; 在 车 辆 跟踪 模块 中 ,使 用 HSV 独 立信 息 构建 目标 联合 颜色 直方 图 。 通 过 在 不 同 模块 中 使 用 不 同 的 颜色 空间 ， 算 法 的 执行 效率 和 和 鲁 棒 性 得 到 提高 。 不 
同 模块 的 平均 耗 时 如 表 3-3 所 示 。 


表 3-3 ”算法 耗 时 统计 


模块 名 称 颜色 空间 平均 耗 时 (ms) 
路 面 分 割 模块 RGB 彩色 空间 2. 04 
车 辆 识别 模块 灰 度 空间 25. 41 





车 辆 跟踪 模块 HSV 彩色 空间 22. 55 


试验 结果 表明 ， 本 节 算 法 最 长 耗 时 控制 在 ?5ms 以 内 ， 满 足 实时 性 要 求 ， 对 城市 交通 环境 中 的 多 目标 车 辆 能 进行 较 好 的 识别 ， 对 于 和 车辆 的 类 型 、 环 境 等 
非 确定 性 变化 具有 较 强 的 免疫 能 力 。 


3.4.6 ”本 节 小 结 


(1) 提出 一 种 路 面 约束 下 车辆 分 层级 联 识 别 和 多 目标 跟 味 算法 。 算 法 在 路 面 区 域 分 割 阶段 ， 提 出 随机 点 上 自生 长 算法 进行 路 面 区 域 分 割 ， 并 以 路 面 区 域 
分 割 结果 为 基础 ， 获 取 感 兴趣 区 域 ， 提 高 了 后 续 模块 的 实时 性 和 和 鲁 棒 性 。 


(2) 车辆 识别 阶段 ， 采 用 Adaboost 机 器 学 习 算 法 进行 分 层级 联 分 类 器 训练 ， 并 引入 LBP 特 征 和 哈 尔 特 征 作 为 目标 描述 方法 ， 分 别 构建 了 检测 级 和 验 


证 级 分 类 器 。 


(3) 车 辆 跟 路 阶段 ， 针 对 粒子 滤波 跟 路 方法 存在 的 问题 ， 提 出 基于 和 车辆 信任 计数 器 的 多 目标 跟 路 方法。 使 用 状态 管理 切换 机 制 ， 解 决 了 车 辆 目标 进入 
和 离开 视野 时 的 跟 踊 问 题 。 


3.5 ”基于 深度 学 习 的 环境 感知 万 六 


深度 学 习 (Deep Learning) 是 近年 来 在 人 工 智能 领域 的 重大 突破 之 一 ， 它 在 语音 识别 、 目 然 语 言 处 理 、 计 算 机 视觉 等 领域 都 取得 了 不 小 的 成 功 。 由 
于 车 辆 行驶 环境 复杂 ， 传 统 感知 技术 在 检测 与 识别 精度 方面 已 无 法 满足 智能 汽车 的 发 展 需 要 ， 深 度 学 习 则 被 证 明 在 复杂 环境 感知 方面 有 巨大 优势。 


3.5.1 神经 网 络 


从 人 类 大 脑 结构 中 ， 科 学 家 们 提出 了 入 工 神经 网 络 。 神 经 网 络 (Neural Network) 的 染 构 类 似 人 脑 神经 ， 关 于 人 神经 网 络 最 好 的 定义 由 马 修 - 梅 奥 
(Matthew Mayo) 给 出 : 神经 网 络 由 大 量 彼此 相连 、 概 念 化 的 人 造 神经 元 组 成 ， 这 些 和 神经 元 之 间 彼 此 传递 着 数据 ， 相 应 的 权重 也 会 随 着 神经 网 络 经 历 而 
进行 调整 。 神 经 元 有 着 激活 的 阅 值 ， 当 直到 相应 的 数据 以 及 权重 时 将 被 激活 ， 这 些 被 激活 的 神经 元 组 合 起 来 束 构 成 了 “学 习 ” 行 为 。 


1. 人 工 神 经 元 
人 工 神 经 元 是 神经 网 络 的 最 基本 单元 ， 它 的 结构 如 图 3-36 所 示 。 


该 单元 也 可 以 被 称 作 Logistic 回 归 模 型 ， 其 中 k 是 权重 ，b 是 偶 关 (Bias) ，f (z) 是 激活 函数 (Activation Function) ，z 的 计算 公式 如 下 : 


z = 0 二 D> xk (3-63) 


二 ] 





图 3-36 人工 神 经 元 


2. 激 活 函 数 


1 
激活 函数 的 作用 是 将 输入 值 映射 到 某 一 区 间 内 ， 一 般 是 (0，1) 区 间 。 在 这 里 介绍 入 单 的 Sigmoid 函 数 ， 表达 式 为 ” “1 +e“， 函 数 图 像 如 图 3-37 


所 示 。 





-10 -8 -6 -4 -2 0 2 4 6 8 10 
图 3-37 Sigmoid 函 数 


Sigmoid 函 数 也 被 称 作 % 形 生长 曲线 ， 同 时 由 于 其 单调 递增 和 反 函 数 单调 递增 等 性 质 ， 该 函数 常 被 用 作 神 经 网 络 的 阀 值 函数 ， 将 变量 映射 到 (0，1) 区 
间 内 。 


激活 函数 一 般 具 有 非 线 性 、 可 微 性 、 单 调 性 等 性 质 。 这 些 性 质 在 神经 网 络 训练 中 友 挥 重要 作用 。 除 了 Sigmoid 函 数 之 外 ， 常 用 的 函数 模型 还 有 tanh 逆 
数 、 线 性 整流 函数 (Rectified Linear Unit，ReLU) 、Maxout 函 数 等 。 


3. 神 经 网 络 结构 与 深度 学 习 


图 3-38 为 一 个 神经 网 络 结构 。 


图 3-38 忆 共有 三 层 ， 每 一 个 圆圈 就 是 一 个 “神经 元 ”， 而 所 谓 的 神经 网 络 就 是 将 许多 个 单一 “神经 元 ”连接 在 一 起 ， 这 样 ， 一 个 “神经 元 ”的 输出 就 
可 以 是 另 一 个 “神经 元 ”的 输入 ， 每 条 线 表示 神经 元 之 间 的 连接 ， 前 一 层 神 经 元 和 后 一 层 神经 元 都 有 连接 关系 则 称 为 全 连接 网 络 。 最 左边 的 一 层 叫 作 输 入 
层 ， 最 右边 的 一 层 叫 作 输 出 层 ， 输 入 层 与 输出 层 之 间 的 叫 作 隐 合 层 。 将 数据 输入 输入 层 ， 经 过 隐 合 层 的 层 层 迭 代 ， 可 以 输出 结果 到 输出 层 ， 这 是 一 个 正 癌 
传播 (Forward Propagation) 。 与 正 同 传播 相对 ， 反 向 传播 则 是 结合 成 本 销 数 的 梯度 来 调整 权重 因子 的 过 程 ， 反 向 传播 在 后 面 对 学 习 模 型 进行 优化 时 具 
有 重要 意义 。 


正 回 传 描 





图 3-38 ”神经 网 络 结构 


在 图 3-38 中 ， 隐 含 层 只 有 一 层 的 神经 网 络 是 最 简单 的 神经 网 络 ， 而 隐 含 层 超过 两 层 的 神经 网 络 叫 作 深度 神经 网 络 ， 如 图 3-39 所 示 。 


正 回 传 播 





图 3-39 ”深度 神经 网 络 结构 


4. 成 本 立 数 与 优化 


昼 经 网 络 在 智能 汽车 领域 最 重要 的 用 途 是 对 图 像 分 类 训练 并 进行 预测 ， 为 了 使 读者 有 直观 的 理解 ， 我 们 给 定 一 张 图 片 作为 神经 网 络 模型 输入 闯 〈 见 图 
3-40) 。 

如 图 3-40 所 示 ， 输 入 端 输 入 一 张 图 像 ， 经 过 隐 合 层 ， 在 输出 端 输 出 结果 ， 定 义 y1 结 果 为 猫 ，y2 为 狗 ， 依 次 定义 到 yn。 在 这 个 模型 中 ， 我 们 希望 使 得 输 
出 端的 最 大 值 所 定义 的 结果 与 原 图 像 表 达 的 结果 一 怪 ， 比 如 在 图 中 我 们 输入 一 张 猫 的 图 片 ， 上 自然 是 希望 输出 表示 猫 的 结果 的 y1 最 大 ， 在 理想 情况 下 ，y1 的 
值 为 1， 其 他 值 为 0。 


辆 入 层 隐 合 层 条 出 层 目标 值 
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图 3-40 ”神经 网 络 的 输入 值 、 输 出 值 与 目标 值 


在 训练 深度 神经 网 络 的 过 程 中 ， 最 主要 的 目标 是 尽 可 能 使 得 该 模型 输出 的 结果 接近 目标 值 ， 为 了 描述 输出 的 真实 值 y 与 理想 值 yi 之 间 的 误差 ， 可 以 采用 
成 本 函数 来 换 绘 。 一 般 使 用 的 成 本 函数 采取 的 是 均 方 差 值 。 为 了 更 好 地 理解 成 本 函数 ， 这 里 以 图 为 例 ， 采 用 均 方 郑 值 型 成 本 函数 摘 述 。 

如 图 3-40 所 示 ， 输 出 层 输 出 真实 值 {y1，y2，.…，yn}， 同 时 模型 的 输出 目标 值 为 {y1i;，y2i，.…，ymi}， 于 是 目标 值 与 真实 值 产生 了 偏差 ， 记 为 Ik,，k= 
{1，2，.…，n}。 人 在 均 万 才 值 型 成 本 消 数 的 条 件 下 ，k 的 计算 公式 为 : 


lk= (yk— Yki) 2 (3-64) 


于 是 成 本 函数 为 


2 1 


k=] 2 pe 
C = 5 (3-0635) 


在 式 (3-65) 中 ，N 代 表 训 练 输入 的 数据 个 数 。 除 了 采用 均 方 卷 值 作 为 成 本 函数 乙 外 ， 还 有 其 他 形式 的 成 本 函数 ， 比 如 交叉 精 型 (Cross Entropy) 成 


C=— > ynlny, 
k=1 


本 函数 : ， 该 函数 模型 在 优化 寻求 最 优 解 时 有 优势 。 


实际 上 ， 模 型 学 习 的 过 程 束 是 围绕 着 成 本 消 数 最 小 化 进行 的 ， 而 成 本 消 数 主要 与 权重 k 和 偏差 b 有 关 ; 取 6= 人 k1，Kk2，…，kN，b1，b2，…，bN}， 则 


成 本 函数 C=C (69) 。 一 般 采 取 的 对 成 本 的 优化 方法 是 梯度 下 降 法 ， 从 起 始点 出 友 ， 一 次 移动 一 点 ， 如 此 重复 下 去 ， 和 直到 达到 局 部 的 极 小 值 ， 此 时 认为 极 
小 值 就 是 成 本 最 小 的 地 万 。 从 数学 上 讲 ， 沿 着 尔 数 的 负 梯 度 运动 束 能 得 到 消 数 的 局 域 最 小 值 。 梯 度 下 降 法 的 公式 如 下 : 


6C(b) 


人 ps 


(3-00 ) 


陈 中 ，qa 代 表 学 习 率 ， 即 每 一 次 欠 代 的 长 度 ， 表 示 梯 度 下 降 的 快慢 ，c 设 置 得 过 小 ， 计 算 速 度 会 很 慢 ; 设置 过 大 则 容易 产生 不 收敛。 如 何 设置 x 是 优化 
的 一 个 难点 。 


在 优化 过 程 中 ， 一 般 会 出 现 两 类 问题 : 梯度 消失 与 梯度 爆炸 。 梯 度 消失 是 指 在 反 向 传播 的 过 程 中 ， 权 重 因 子 会 被 多 次 乘 以 小 的 梯度 ， 因 此 会 越 变 越 
小 ， 随 着 递归 的 深入 趋 于 “消失 ”， 使 得 神经 网 络 失去 长 程 可 靠 性 ， 梯 度 消失 的 问题 可 以 通过 来 用 ReLU 激 活 尔 数 缓解 ， 但 并 不 能 完全 解决 梯度 消失 问题 。 


梯度 爆炸 则 是 指 在 反 向 传播 的 过 程 中 ， 部 分 节 扣 的 大 梯度 使 得 它们 的 权重 变 得 非常 大 ， 从 而 削弱 了 其 他 节点 对 于 结果 的 影响 ， 梯 度 爆 炸 可 以 通过 截断 
( 即 设置 一 个 梯度 允许 的 最 大 值 ) 的 方式 来 有 效 避 免 。 


3.5.2 ”大 积 神经 网 络 

智能 汽车 中 的 视觉 感知 主要 用 的 是 卷 积 神经 网 络 (Convolutional Neural Network，CNN) 。 卷 积 神经 网 络 已 经 被 证 明 在 图 像 处 理 中 有 很 好 的 效 
果 。 相 比 传统 的 图 像 处 理 算法 ， 卷 积 神 经 网 络 的 优点 在 于 可 以 避免 对 图 像 进 行 复杂 的 前 期 预 处 理 过 程 (提取 人 工 特征 等 ) ， 直 接 输 入 原始 图 像 。 在 本 小 节 
中 主要 讲解 卷 积 层 和 池 化 (Pooling) 层 工作 的 基本 原理 ,介绍 推动 卷 积 神经 网 络 发 展 的 AlexNet 结 构 模 型 以 及 能 够 解决 输入 图 片 大 小 不 同 的 全 卷 积 神经 网 
络 (FCN) 。 


1. 卷 积 层 的 工作 过 程 














图 3-41 3 义 3 卷 积 核 的 卷 积 过 程 


卷 积 层 是 卷 积 核 企 上 一 级 输入 层 上 通过 逐一 滑动 窗口 计算 而 得 的 ， 简 单 来 况 ， 图 像 是 一 个 像素 所 隆 ， 针 对 该 矩阵 融 可 以 通过 卷 积 核 进行 卷 积 ， 如 图 3- 
41 所 泵 。 


图 3-41 是 一 个 3x3 卷 积 核 (也 被 称 作 滤波 器 ) ， 从 图 像 的 左上 角 开 始 向 右 或 向 下 移动 ， 对 移动 过 程 中 覆盖 的 区 域 求 加 权 和 。 最 后 得 到 (4-3+1) x (4- 
3+1) 大 小 的 卷 积 结果 ， 被 称 为 一 个 特征 图 (feature map) 。 除 了 这 种 最 普通 的 卷 积 方式 之 外 ， 还 有 扩张 卷 积 (Dilated Convolution) [16l、 可 变形 卷 


积 (Deformable Convolution) [11、 深 度 可 分 离 卷 积 (Depthwise Separable Convolution) 118] 等 卷 积 方式 。 
2. 池 化 层 的 工作 过 程 


池 化 可 以 进一步 减少 变量 的 数目 同时 防止 过 拟 合 ， 池 化 的 作用 主要 是 将 上 一 层 卷 积 获 得 的 特征 进行 分 类 ， 它 与 用 所 有 提取 得 到 的 特征 去 训练 分 类 器 的 
方法 的 不 同 之 处 在 于 : 一 是 减少 参数 数量 ， 二 是 使 模型 具有 较 好 的 平移 不 变 性 。 池 化 和 卷 积 很 类 似 ， 不 同 之 处 在 于 卷 积 核 覆 盖 的 区 域 是 重 蔷 的 ， 而 池 化 的 
各 个 区 域 是 没有 重 芍 的， 








图 3-42 ”最 大 值 池 化 过 程 
而 且 一 般 采 用 的 池 化 方法 是 将 原始 图 片 中 每 个 4x4 分 块 取 最 大 值 形 成 一 个 新 的 矩阵 ， 这 叫 作 最 大 值 池 化 (Max Pooling) 。 具 体 过 程 如 图 3-42 所 示 。 


3.AlexNet 的 结构 


2012 年 ，Alex 在 ImageNet 比 赛 上 提出 了 一 种 模型 一 一 AlexNetl13] (以 第 一 作者 Alex 命 名 ) ， 并 且 夺 得 冠军 。 这 个 模型 首先 证 明了 CNN 在 复杂 模型 
下 的 有 效 性 ， 具 有 很 重要 的 意义 。 该 模型 的 结构 如 图 3-43 所 示 ， 图 中 的 “dense” 表 示 对 于 每 一 层 网 络 来 说 ， 前 面 所 有 网 络 的 特征 图 都 被 作为 输入 ， 同 时 
其 特征 图 也 都 被 其 他 网 络 层 作为 输入 所 利用 。 


从 图 3-43 中 可 以 看 出 ，AlexNet 包 括 八 个 带 权 层 : 前 五 层 是 卷 积 层 ， 剩 下 的 三 层 是 全 连接 层 。 第 一 个 卷 积 层 利用 96 个 大 小 为 11x11x3、 步 长 为 4 个 像 
素 (这 是 同一 个 核 映射 中 邻近 神经 元 的 感受 与 中 心 之 间 的 距离 ) 的 核 ， 来 对 大 小 为 224x224x 3 的 输入 图 像 进行 滤波 。 第 二 个 卷 积 层 需要 将 第 一 个 卷 积 层 的 
(响应 归 一 化 及 池 化 的 ) 输出 作为 自己 的 输入 ， 目 利用 256 个 大 小 为 5x5x48 的 核对 其 进行 滤波 中。 第 三 、 第 四 和 第 五 个 卷 积 层 彼此 相连 ， 没 有 任何 介 于 中 
间 的 池 化 层 与 归 一 化 层 。 第 三 个 卷 积 层 有 384 个 大 小 为 3x3x256 的 核 被 连接 到 第 二 个 卷 积 层 的 〈 归 一 化 、 池 化 的 ) 输出 。 第 四 个 卷 积 层 有 384 个 大 小 为 
3x3x192 的 核 ， 第 五 个 卷 积 层 有 256 个 大 小 为 3x3x192 的 核 。 全 连接 层 都 各 有 4096 个 神经 元 。 


与 以 前 的 卷 积 神经 网 络 的 不 同 之 处 在 于 ，AlexNet 及 用 了 非 线 性 的 ReLU 激 活 函 数 ， 采取 了 防止 过 拟 合 的 方法 
使 用 了 百 万 级 ImageNet 图 像 数据 来 进行 大 数据 训练 ， 同 时 使 用 了 GPU ， 实 现 了 局 部 响应 归 一 化 层 (Local Response Normalization，LRN) 。 
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图 3-43 ”Alexnet 结 构图 [1 
4. 全 卷 积 神经 网 络 


全 卷 积 神经 网 络 (FCN) 是 将 传统 CNN 中 的 全 连接 层 转化 成 一 个 个 卷 积 层 (< 中 。 对 于 一 个 各 层 参 数 结构 都 设计 好 的 网 络 模型 来 说 ， 输 入 的 图 片 大 小 是 
固定 的 ， 比 如 AlexNet 设 计 完毕 后 ， 网 络 输入 的 图 片 大 小 就 是 227x 227， 而 FCN 的 优势 在 于 能 够 输入 任意 大 小 的 图 片 ， 让 网 络 可 以 一 直 向 前 传导 。FCN 的 
工作 过 程 如 图 3-44 所 示 。 





图 3-44 FCN 的 工作 过 程 


在 图 3-44 中 FCN 可 以 输入 任意 大 小 的 图 片 ， 如 输入 15x15 大 小 的 图 片 得 到 最 后 的 输出 是 一 张 与 输入 图 片 大 小 息息相关 的 2x2 大 小 的 图 片 ， 其 精髓 在 
于 ，4x4 大 小 的 图 片 转化 为 2x2 大 小 的 图 片 的 过 程 不 是 像 前 面 训 的 全 连接 ， 而 是 采用 3x3 的 卷 积 核 进 行 卷 积 ， 因 而 输入 图 片 可 以 是 任意 大 小 的 。 


[1] 48 对 应 第 一 层 得 到 的 48 个 map， 即 第 一 层 的 所 有 map 卷 积 生成 第 二 层 的 一 个 map 图 。 


3.5.3 ”CNN 在 智 舱 气 车 环境 感知 中 的 应 用 


天 于 深度 学 习 在 智能 汽车 上 面 的 应 用 有 很 多 ， 比 如 路 径 识 别 、 行 人 识别 、 道 路 标志 识别 和 信号 灯 识别 、 环 境 识 别 、 障 碍 物 及 车 辆 识别 等 许多 应 用 。 本 
小 节 主 要 介绍 CNN 在 行人 识别 、 和 车辆 识别 、 车 辆 可 通行 区 域 分 割 等 中 的 具体 应 用 。 


1. 基 于 YOLO 的 行人 识别 


2016 年 ，Ross Girshick 等 提出 了 YOLO (You Only Look Once) 1，YOLO 是 目前 比较 流行 的 物体 检测 算法 ，YOLO 将 物体 检测 任务 当 作 一 个 回归 
问题 来 处 理 ， 使 用 一 个 神经 网 络 ， 直 接 从 一 整 张 图像 的 所 有 像素 来 预测 出 边界 框 的 坐标 ， 框 中 包含 物体 的 置信 和 度 和 物体 的 可 能 性 。 因 为 YOLO 的 物体 检测 
流程 是 在 一 个 神经 网 络 里 完成 的 ， 所 以 可 以 以 端 到 端 来 优化 物体 检测 性 能 。YOLO 检 测 网 络 结构 如 图 3-45 所 示 。 
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图 3-45 YOLO 结 构 
该 网 络 包 括 了 24 个 卷 积 层 和 2 个 全 连接 层 ， 卷 积 层 用 来 提取 图 像 特征 ， 全 连接 层 用 来 预测 图 像 位 置 和 类 别 概率 值 。 


整个 网 络 的 流程 如 图 3-46 所 示 。 


使 用 新 加 入 的 卷 积 层 有 更 好 的 表现 
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图 3-46 YOLO 网 络 流程 图 


YOLO 的 损失 函数 为 : 
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第 一 项 是 边界 框 中 心 坐标 的 误差 项 ， 第 二 项 是 边界 框 的 高 与 完 的 误差 项 ， 第 三 项 是 包含 目标 的 边界 框 的 置信 度 误差 项 ， 第 四 项 是 不 包含 目标 的 边界 框 


的 置信 和 度 误 差 项 ， 最 后 一 项 是 包含 目标 的 单元 格 的 分 类 误差 项 。 
训练 模型 后 得 到 的 行人 预测 结果 如 图 3-47 所 示 。 
2. 基 于 Faster R-CNN 的 车 辆 识别 


Faster R-CNNI22] 是 在 R-CNN 的 基础 上 不 断 改进 得 到 的 。R-CNN 由 Ross Girshick 等 人 提出 ， 主 要 解决 了 图 像 识 别 以 及 物体 定位 的 问题 。[23]R-CNN 
的 基本 思路 是 先 利用 图 像 识别 的 基本 网 络 算法 ， 之 后 将 该 网 络 结构 在 全 连接 层 处 分 为 两 个 分 支 ， 一 个 做 物体 定位 ， 另 一 个 做 物体 分 类 。 其 中 物体 定位 就 是 
要 获得 物体 在 图 像 中 的 基本 坐标 ， 然 后 在 物体 周围 画 框 将 图 像 围 住 即 可 。 





图 3-47 ”预测 行人 边界 框 


随后 空间 金字 塔 池 化 方法 (Spatial Pyramid Pooling，SPPNet) [4 的 提出 给 R-CNN 的 改进 提供 了 一 种 思路 ， 于 是 产生 了 R-CNN 与 SPPNet 结 合 的 
Fast-R-CNNI2>]。Fast-R-CNN 考 虑 到 R-CNN 中 的 生成 区 域 建议 以 及 逐 层 计算 十 分 耗 时 ， 于 是 改进 为 只 在 最 后 一 层 卷 积 前 进行 生成 区 域 建议 ， 然 后 用 单 层 
的 SPPNet 将 选取 的 几 个 区 域 通过 池 化 划分 为 全 连接 层 所 需要 的 数据 尺寸 ， 这 种 池 化 方法 被 称 为 ROI 池 化 。 
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图 3-48 ”Faster R-CNN 的 网 络 结构 


Fast-R-CNN 很 好 地 解决 了 卷 积 层 对 建议 区 域 重 复 计 算 的 问题 ， 提 高 了 神经 网 络 的 训练 速度 ， 但 是 ROI、 回 归 以 及 分 类 实现 的 是 独立 训练 而 不 是 整体 更 
新 参数 ， 此 外 选择 性 搜索 (Selective Search) 方法 产生 的 建议 框 生成 速度 仍旧 很 慢 。 于 是 Faster R-CNN 的 改进 在 此 基础 上 将 原 有 的 建议 区 域 选择 方式 变 
为 用 卷 积 网 络 的 万 式 来 实现 ， 即 区 域 建议 网 络 (Region Proposal Network，RPN) ， 整 体 结构 如 图 3-48 所 示 。 区 域 建 议 网 络 的 建议 框 生 成 速度 要 优 于 之 
前 的 算法 ， 提 高 了 神经 网 络 的 运算 速度 与 精度 ， 简 化 了 神经 网 络 的 训练 过 程 。 


训练 模型 后 得 到 的 车 辆 预测 结果 如 图 3-49 所 示 。 





图 3-49 ”预测 车 辆 边界 框 


目前 基于 雷达 传感器 和 传统 图 像 处 理 的 车 辆 前 方 可 通行 区 域 检测 方法 ， 在 智能 汽车 上 的 应 用 已 经 取得 了 一 定 的 成 果 ， 例 如 谷歌 无 人 驾驶 汽车 、 特 斯 拉 
无 人 驾驶 等 。 对 于 和 车辆 前 方 可 通行 区 域 的 检测 ， 要 求 能 足够 准确 地 将 可 通行 的 道路 与 车 辆 、 行 人 及 障碍 物 区 分 开 来 。 基 于 深度 卷 积 神经 网 络 的 语义 分 割 算 
法 SegNet'“ 在 室内 和 室外 已 经 可 以 达到 对 图 片 中 物体 进行 准确 边界 分 割 的 目的 。 


SegNet 的 网 络 结构 为 : 主体 是 一 个 编码 器 网 络 和 一 个 相对 应 的 解码 器 ， 后 部 连接 一 个 最 终 的 像素 级 分 类 层 。SegNet 的 结构 如 图 3-50 所 示 。 


卷 积 编码 器 -解码 器 





国 国 Upsampling Softma 





a Conv+Batch Normalisation+ReLU 


图 3-50 SegNet 的 结构 


编码 器 网 络 由 13 个 卷 积 层 组 成 ， 这 些 卷 积 层 对 应 于 VGG16 网 络 设计 的 前 13 个 卷 积 层 ， 用 于 对 象 分 类 。 因 此 ， 它 可 以 直接 加 载 ImageNet 预 训练 的 权 
重 ， 训 练 用 于 大 型 数据 集 分 类 。segNet 去 掉 了 VGG16 网 络 中 的 全 连接 层 结构 ， 这 样 可 以 在 最 末端 的 编码 器 输出 端 保留 更 高 分 辨 率 的 特征 映射 。 与 最 近 其 
他 的 结构 如 FCN、DeconvNet 等 相 比 ， 去 掉 全 连接 层 同时 也 减少 了 SegNet 编 码 器 网 络 中 的 参数 数量 ， 从 134M 减 少 到 14.7M。 每 个 编码 器 层 具 有 相应 的 解 
码 器 层 ， 因 此 解码 器 网 络 也 是 13 层 。 最 终 的 解码 器 输出 被 馈送 到 多 种 类 的 Softmax 分 类 器 ， 该 分 类 器 可 以 独立 地 为 每 个 像素 产生 类 别 概率 值 作 为 输出 。 


训练 好 的 模型 测试 如 图 3-51 所 示 。 
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图 3-51 道路 可 通行 区 域 结 果 


图 3-51 的 左边 为 测试 原 图 ， 右 边 为 SegNet 测 试 输出 图 片 。 测 试 输出 图 片 中 框 线 区 域 为 可 通行 区 域 ， 其 余部 分 为 其 他 背景 。 


3.6 ”基于 油光 雷达 的 感 井 近 林 


激光 雷达 (LiDAR) 在 智能 汽车 感知 领域 的 应 用 十 分 广泛 ， 目 前 主要 应 用 于 地 图 的 绘制 、 定 位 以 及 障碍 检测 。 在 本 节 中 ， 我 们 首先 讨论 激光 雷达 的 基 
础 知识 和 在 智能 汽车 环境 感知 领域 中 的 应 用 。 


3.6.1 ”激光 备 达 基础 
从 测试 目标 来 说 ， 激 光 雷 达 分 为 激光 测 距 雷达 、 激 光 测 速 雷 达 、 激 光 测 角 雷 达 ; 其 中 激光 测 距 雷达 可 分 为 脉冲 激光 测 距 雷 达 和 连续 波 相 位 激光 测 距 雷 
达 两 类 E 7]。 一 般 智 能 汽车 所 用 的 激光 雷达 主要 是 脉冲 激光 测 距 雷达 。 


脉冲 激光 测 距 雷 达 对 目标 发 射 一 个 或 一 列 很 窄 的 光 脉 中 (脉冲 宽度 小 于 50ns) ， 测 量 自发 射 光 脉冲 起 始 ， 到 达 目 标 ， 并 由 目标 返回 到 接收 机 的 时 间 ， 
由 此 计算 出 目标 距离 。 假 设 目标 距离 为 R， 光 脉冲 往返 经 过 的 时 间 为 t， 光 在 空气 中 的 传播 速度 为 c， 则 : 


ct | 
R = 7 (3-68) 


脉冲 激光 测 距 雷达 是 通过 采用 计量 器 计量 这 一 时 间 间 隔 内 ， 进 入 计数 器 的 钟 频 脉 冲 个 数 来 测量 距离 的 。 设 在 这 段 时 间 里 ， 有 mn 个 钟 频 脉 冲 进入 计数 器 ， 
钟 频 脉 站 之 间 的 时 间 间 隔 为 tr， 钟 频 脉冲 的 振荡 频率 为 f=1/t， 则 : 


R= DF nT 一 划一 (3-69) 


1 = 二 
在 式 (3-69) 中 ， 人 ， 表 示 每 一 个 钟 频 脉冲 所 代表 的 距离 基准 ， 计 数 得 到 n 个 钟 频 脉冲 ， 就 可 以 得 到 探测 的 距离 R。 


目前 在 智能 汽车 领域 运用 广泛 的 雷达 主要 是 Velodyne 激 光 雷 达 ， 几 乎 所 有 公司 在 智能 汽车 开发 时 都 在 及 用 Velodyne 的 产品 。 以 HDL-64E 为 例 ， 该 球 
产品 是 一 个 64 线 激光 雷达 ，64 线 是 指 发 射 64 个 激光 束 ， 从 而 能 够 获得 更 多 的 点 云 数据 来 重 构 车 辆 周围 的 3D 环 境 。 


Velodyne 激 光 雷 达 需 要 机 械 旋转 ， 不 是 固态 激光 雷达 ， 虽 然 Velodyne 宣 称 VLP-16 产 品 采 用 了 固态 混合 技术 ， 但 实际 上 其 技术 与 HDL-32E 基 本 一 样 ， 
只 不 过 VLP-16 是 在 HDL-32E 的 基础 上 减少 了 16 线 ， 并 对 结构 进行 了 优化 。HDL-64E、HDL-32E 与 VLP-16 采 用 的 都 是 同一 种 技术 。 图 3-52 为 HDL-64E、 
HDL-32E 与 VLP-16 的 内 部 结构 图 。 


Velodyne 的 所 有 产品 在 俯仰 万 向 上 均 采 用 这 种 “固态 扫 拉 ”技术 进行 扫 摘 ， 在 方位 方向 通过 机 械 扫 摘 实 现 360" 旋 转 扫 摘 ， 这 融 是 Velodyne 的 “固态 


混合 扫 摘 ”。 
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c ) VLP-16 内 部 结构 


图 3-52 HDIL-64E、HDL-32E 与 YLP-16 的 内 部 结构 图 


2.Quanergy 激 光 雷 达 
2016 年 ，Quanergy 发 布 了 Soild State LiDAR S3 (简称 S3) 并 且 在 CES2017 上 获得 了 汽车 智能 类 最 高 奖项 一 一 最 佳 创 新 奖 ， 宣布 








将 大 规模 量 产 53， 这 意味 着 S3 是 全 球 首 个 低 成 本 的 固态 LiDAR。 这 将 改变 智能 汽车 LiDAR 的 成 本 问题 


公开 的 资料 显示 ，Quanergy 激 光 雷 达 玉 用 的 是 光学 相 控 阵 技术 ， 类 似 相 控 阵 雷 达 ， 如 图 3-53 所 示 。 该 雷达 的 工作 原理 是 利用 相位 差 得 到 不 同 视角 的 
扫 摘 ， 主 要 通过 调 市 友 射 器 控制 阵列 的 激光 相位 来 改变 友 射 激光 角度 。 


顶点 








ee 远 场 辐射 模式 
发 射 机 (光学 相 控 阵 ) 光子 覆盖 各 种 转向 角 
集成 电路 和 远 场 辐射 ( 激光 ) 


图 3-53 Quanergy Soild State LiDAR S3 激 光 雷 达 


3.6.2 LiDAR 的 外 参数 标定 


激光 雷达 间 的 相对 位 置 和 姿态 的 标定 对 提高 多 激光 雷达 系统 的 数据 融合 和 测量 精度 至 关 重要 。 因 此 我 们 需要 在 LiDAR 应 用 之 前 ， 对 它 进行 标定 ， 这 主 
要 是 为 了 确定 目标 物 反射 率 和 与 测量 功率 有 关 的 雷达 常数 的 数值 
激光 雷达 与 车 体 为 刚性 连接 ， 两 者 间 的 相对 姿态 和 位 移 固定 不 变 ， 为 了 处 理 数据 的 方便 性 ， 需 要 把 各 个 激光 雷达 的 坐标 系 转化 为 统一 的 车 体 坐 标 
系 [“ |。 以 多 激光 雷达 系统 中 的 任 两 台 激 光 雷 达 作为 研究 对 象 〈 其 他 的 以 此 类 推 ， 研 究 方法 相同 ) ， 两 台 激 光 雷 达 安装 于 同一 车 载 平台 上 ， 设 两 台 激 光 雷 达 
测量 坐标 系 分 别 为 S1 和 S2。 于 是 两 个 坐标 系 存在 相对 的 旋转 平移 变换 关系 ， 用 公式 表示 则 为 : S2= RS1+T。 与 前 面 的 相机 模型 类 似 ，R 为 3x 3 矩阵， 包含 三 
个 独立 变量 w、5、6， 即 两 个 坐标 系 之 间 的 相对 旋转 角 ， 表 示 两 个 坐标 系 间 的 旋转 变换 ，T 为 3x 1 矩阵 ， 表 示 两 个 坐标 系 间 的 平移 变换 ， 也 包含 三 个 相互 独 

立 的 平移 变量 。 这 样 就 将 激光 雷达 的 标定 问题 转化 成 了 坐标 系 变换 关系 的 求解 问题 。 

设 空间 中 任意 两 个 点 P1 和 P2， 向 量 V=P1P2 在 坐标 系 S1 和 S2 中 分 别 为 v1 和 v2 (已 归 一 化 ) ， 其 中 v1 和 v2 称 为 一 对 同名 向 量 ， 且 有 v2= Rv1。 只 需 两 组 或 
以 上 对 应 的 v1/、v2， 即 可 实现 旋转 矩 阵 P 的 求解 。 其 中 P 包 括 9 个 元 素 ， 对 于 标定 来 说 ， 只 要 求解 这 9 个 元 素 即 可 。 但 是 根据 常用 的 旋转 角 求 解法 求解 旋转 短 
阵 过 于 繁复 ， 所 以 一 般 将 坐标 系 的 旋转 采用 Rodrigues 法 描述 。 


3.6.3 ”障碍 物 检测 


在 民 好 的 环境 下 ，LiDAR 在 道路 检测 中 针对 物体 远近 的 判断 是 十 分 精准 的 ， 正 好 可 以 弥补 单 目 视 营 中 相机 针对 2D 图 像 难以 判断 3D 距 离 的 缺陷 ， 但 前 提 
是 要 有 良好 的 条 件 。 这 是 因为 光学 雷达 会 受到 空中 悬浮 物 (比如 雾 林 天 气 ) 等 的 影响 ， 空 气 中 的 传播 介质 可 能 导致 光速 变化 ， 从 而 使 得 测量 精度 下 降 。 不 


过 虽然 有 这 些 因素 的 影响 ， 但 总 的 来 说 LiDAR 能 够 比较 准确 地 生成 点 云 (Point Cloud) 识别 障碍 物 的 距离 、 大 小 甚至 表面 形状 ， 另 外 基于 多 目 视 党 相机 的 


环境 感知 算法 的 复杂 度 高 于 基于 LiDAR 的 算法 。 


图 3-54 是 一 种 基于 LiDAR 的 障碍 物 检测 (车 辆 目标 检测 ) 步骤 I*?3。 


~- 障碍 物 聚 类 | 一 一 > 目标 特征 提取 | 一” 特征 判定 识别 





图 3-54 ”一 种 基于 LiDAR 的 障碍 物 检 测 步 又 
在 一 个 周期 内 LiDAR 的 每 个 激光 上 友 射 器 上 友 射 激光 后 反射 回来 得 到 所 有 上 友 射 点 的 坐标 便 形 成 了 点 云 。 近 年 来 ， 随 看 立体 视 郭 技术 和 三 维 扫 摘 仪 、 激 光 雷 
达 等 坐标 测量 设备 的 逐步 普及 ， 点 云 数据 的 获取 越 来 越 快捷 。 利 用 三 维 激光 雷达 可 以 快速 生成 目标 环境 的 三 维 模 型 ， 较 之 传统 的 测绘 手段 更 加 方便 、 快 
捷 ， 大 大 简化 了 复杂 的 建 模 过 程 ， 为 快速 重建 三 维 环境 提供 了 可 能 。 
六 云 的 操 坐 标 获取 过 程 如 图 3-55 所 示 ， 已 知 LiDAR 是 固定 的 ， 夷 直角 为 a; 反射 点 A 与 LIDAR 的 距离 可 以 直接 得 到 为 L， 同 时 LIDAR 会 记录 当前 转动 的 水 


平角 度 为 B， 于 是 以 LiDAR 为 原点 的 测量 点 三 维 坐 标 就 是 (LcosacosB，LcosasinB,，Lsina) 。 
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图 3-55 ”点 云 的 点 坐标 获取 


然而 由 于 点 云 模型 中 点 的 数量 过 多 ， 三 维 激光 雷达 数据 分 割 涉及 大 量 的 代数 运算 ， 给 实时 处 理 市 来 了 巨大 的 困难 ， 所 以 采用 三 维 点 云 表示 的 场景 并 不 
能 直接 根据 其 三 维 坐 标 进行 环境 理解 。 于 是 我 们 可 以 通过 数据 点 的 几何 特征 表示 点 云 。 根 据 其 k 邻 域 的 点 估计 其 表面 曲率 和 法 向 量 是 比较 常用 的 点 特征 表示 


方法 。 利 用 雷达 点 云 可 以 有 效 地 解决 基于 视觉 的 环境 感知 在 背景 和 目标 之 间 特 征 分 割 不 明显 情况 下 的 难以 识别 的 问题 ， 从 而 大 大 提高 障碍 物 的 检测 精度 。 
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在 紧急 工 况 下 ， 当 前 自动 紧急 制 动 系统 (Autonomous Emergency Braking，AEB 系 统 ) 已 经 较为 成 熟 并 进入 规模 化 商用 阶段 ， 比 如 沃尔沃 
(Volvo) 的 城市 安全 (City Safety) 系统 [上 ]、 奔 驰 的 PRE-SAFE 系 统 台 等 。AEB 系 统 在 碰撞 危险 非常 高 时 通过 自动 紧急 制 动 来 避免 磁 撞 或 减轻 碰撞 程 
度 ，Euro-NCAP (欧盟 新 车 认证 程序 ) 也 于 2014 年 引入 了 对 AEB 城 市 系统 (AEB CITY) 和 AEB 公 路 系统 (AEB Inter-Urban) 的 测试 和 评价 D。 


AEB 系 统 属 于 高 级 驾驶 辅助 系统 (ADAS) 的 范畴 ， 只 能 通过 制 动 来 避免 碰撞 ， 车 辆 的 辜 撞 潜力 没有 得 到 最 大 程度 的 友 挥 。 同 时 ， 该 系统 在 处 理 驾 驶 员 
输入 和 和 车辆 控制 输入 的 关系 上 还 存在 较 大 的 缺陷 。 出 于 责任 回避 考虑 ， 在 当前 的 AEB 系 统 控制 策略 中 ， 无 论 各 驶 员 的 输入 是 否 正确 ， 驾 驶 员 输 入 的 优先 级 
都 比 系统 控制 输入 高 。 在 AEB 系 统 介 入 时 ， 如 果 和 驾驶 员 急 打 方 同 盘 或 急躁 油门 踏板 ， 系 统 介 入 会 自动 取消 。 这 是 企业 出 于 回避 法 律 责任 的 需要 而 米 取 的 一 
种 保守 策略 ， 但 却 并 不 是 一 种 最 优 策略 ， 智 能 汽车 安全 技术 的 潜力 并 未 得 到 充分 的 友 挥 。 在 AEB 系 统 介 入 时 ， 和 驾驶 员 “ 呆 若 木 鸡 ” 以 至 于 对 和 车辆 几乎 没有 
干预 或 许 是 一 种 最 好 的 状态 。 

但 从 驾驶 员 行 为 分 析 结 果 可 知 ， 在 紧急 工 况 下 及 取 转 向 避 撞 是 驾驶 员 的 一 种 自然 反应 ， 但 这 种 崇 急 转向 行为 通 弟 伴随 着 制 动 ， 和 车辆 处 于 高 度 非 线性 状 


态 ， 因 此 和 车辆 很 难 控制 ， 各 驶 员 通 常 没有 足够 的 经 验 应 付 ， 往 往 出 现 过 晚 转向 导致 小 偏 置 磁 撞 、 过 激 转 向 导致 越 出 车 道 、 过 激 转 向 同时 制 动 导致 失 稳 等 情 
况 ， 使 得 友 生 更 为 严重 的 事故 ， 我 国 的 重 特大 事故 中 相当 一 部 分 也 都 源 出 于 此 。 因 此 ， 有 必要 对 驾驶 员 的 紧急 转向 行为 进行 辅助 。 


本 章 基 于 驾驶 员 在 紧急 工 况 下 的 转向 行为 ， 在 AEB 控 制 策略 基础 上 ， 提 出 了 一 种 自动 紧急 控制 (Autonomous Emergency Control，AEC) 的 控制 策 
， 通 过 引入 转向 控制 来 提供 更 为 全 面 的 辅助 ， 提 高 避 撞 效能 。 


喜 


4.1 转向 避 撞 效能 及 可 行 性 分 析 


4.1.1” 避 撞 所 需 最 得 纵 同 距离 


驾驶 员 避 撞 的 方式 通常 有 制 动 、 转 向 以 及 制 动 同时 转向 三 种 ， 不 同 的 避 撞 方式 的 避 撞 效能 不 一 样 。 避 撞 效 能 的 不 同 主要 体现 在 避 撞 所 需 的 最 短 纵向 距 
离 不 同 ， 如 图 4-1 所 示 。 本 节 将 对 这 三 种 避 撞 方式 的 避 撞 效能 进行 分 析 ， 简 单 起 见 ， 本 节 采 用 质点 后 辆 模型 进行 分 析 。 


所 需 纵向 距离 ，4 





图 4-1 不 同 避 樟 方 式 所 需 的 纵向 避 撞 距离 


将 于 辆 视 作 一 个 质点 ( 见 图 4-2) ， 和 车辆 坐标 系 为 xoy，x 轴 沿 车 辆 纵向 指向 车 辆 前 进 万 向 ，y 轴 沿 车 辆 侧 向 指向 车 辆 左 侧 ， 和 车 辆 在 世界 坐标 系 XOY 中 具 
有 X、Y 两 个 运动 目 由 度 。 





图 4-2 车辆 质点 模型 


车 辆 在 XOY 坐 标 系 下 的 运动 微分 方程 为 : 
1 不 一 Fcos(y) -Fsin(y) 
时 0 | ) 
mY= Fsin(w) + F,cos(y) 


其 中 ，m 为 车 辆 质量 ， 由 为 车 辆 航向 角 ， 即 车 辆 坐标 系 x 轴 与 世界 坐标 系 X 轴 之 间 的 夹 角 ，Fx 和 Fy 为 实际 作用 在 车 辆 上 的 轮胎 力 。 


轮胎 力 Fx 和 Fy 受到 轮胎 摩擦 圆 的 约束 ， 因 此 ， 和 车 辆 的 加 速度 应 满足 如 下 关系 : 


| 人 ) + | a, ) (+ (2 <1 (4-2) 


,an Ynan ,an 学 a lnNan 








其 中 ，ax、ay 为 车 辆 的 纵向 和 横向 加 速度 ，ax，max、ay，max 是 车 辆 纵横 向 能 产生 的 最 大 加 速度 。ax，max=H9，bH 为 道路 摩擦 系数 ，g 为 重力 加 速度 。 
ay，max 受 到 道路 摩擦 系数 和 车 辆 抗 侧 翻 性 能 要 求 的 影响 ， 通 常情 况 下 ay, max<H9。 


V, =X, V,=Y 


引入 状态 变量 z，z= [X,Y，Vx，Vy] 1'，Vx、Vy 为 车 辆 沿 X 轴 和 Y 轴 的 速度 ， `。 车 辆 的 状态 方程 为 : 


X ] i 
y | 

:=| |= ’ (4-3) 
Vy Fcos(y) -Fsin(y) Im 


Vy Fsin(y) + Fcos(y) Im 


系统 输入 u= (Fx,， Fy) T。 设 驾驶 员 开始 避 撞 行 为 的 时 刻 为 0 时 刻 ， 车 辆 的 初始 状态 为 X (0) =Xo, Y (0) =Yo, Vy (0) =Vyo, Vx (0) =Vxo。 避 
撞 结 束 时 刻 为 T， 和 车辆 在 T 时 刻 的 状态 为 X (T) =XT, Y (T) =YT, Vy (T) =VYT，VXx (T) =VXKT。 为 了 求 最 短 纵向 避 撞 距离 ， 即 求 输入 u 使 得 XT 最 小 ， 设 
minX( 7) 


初始 时 刻 状态 变量 Yo=0，Vyo=0， 求 目标 函数 “ 

考虑 以 下 三 种 情况 : 

(1) 制 动 避 撞 ， 即 输入 Fy=0， 和 车辆 最 终 状态 YT=0，VXT=0。 

(2) 转向 避 撞 ， 即 输入 Fx=0， 车 辆 最 终 状态 YT= b，b 为 车 辆 避 撞 所 需 的 侧 向 距离 ，VYT=0， 即 车 辆 避 撞 完成 后 侧 向 速度 为 0。 

(3) 制 动 + 转向 避 撞 ，YT=b，VYT=0。 

设 车 辆 质量 m=1000kg， 道 路 摩擦 系数 Hb=0.8， 车 辆 避 撞 所 需 的 侧 向 距离 b= 3.0 米 ， 车 辆 最 大 纵向 加 速度 ax，max=0.8g， 不 考虑 侧 翻 ， 车 辆 最 大 侧 向 
加 速度 ay，max=0.8g。 采 用 Tomlab 的 PT Pro 软 件 计算 不 同 避 撞 方式 所 需 的 纵向 距离 中， 结果 如 图 4-3 所 示 。 可 以 看 出 ， 在 低速 时 ， 制 动 避 撞 所 需 距离 更 


短 ， 但 当 车 速 高 于 69.4km/h 时 ， 转 向 避 撞 所 需 的 纵向 距离 更 短 。 转 向 的 同时 制 动 能 够 进一步 减 小 纵向 避 撞 距离 ， 当 和 车速 高 于 59.6km/h 时 ， 制 动 + 转向 的 
避 撞 方式 所 需 纵向 距离 小 于 制 动 避 撞 距离 。 
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图 4-3 ”纵向 避 樟 距离 (hu=0.8，b=3.0m) 


保持 其 他 条 件 不 变 ， 设 道路 摩擦 系 数 H= 0.3， 不 同 避 撞 方 式 所 需 的 纵向 避 撞 距离 如 图 4-4 所 示 ， 当 道路 摩擦 系数 降低 时 ， 转 向 避 撞 相对 于 制 动 避 撞 的 优 
势 更 为 明显 ， 当 和 车速 高 于 43.6km/h 时 ， 转 向 避 撞 所 需 的 纵向 距离 比 制 动 所 需 的 纵向 距离 更 短 ， 转 向 同时 制 动 能 够 进一步 减 小 避 撞 所 需 纵向 距离 ， 相 对 于 制 
动 避 撞 的 临界 车 速 为 38.1km/h。 
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图 4-4 ”纵向 避 撞 距离 (nu=0.3，b=3.0m) 


保持 道路 摩擦 系数 H=0.8， 设 转向 避 撞 所 需 的 侧 向 位 移 b 分 别 为 ?m，1.5m 和 0.5m， 三 种 情况 下 转向 避 撞 及 转向 同时 制 动 避 撞 所 需 纵向 距离 如 图 4-5 所 
示 。 当 如 撞 所 需 的 侧 向 位 移 减 小 时 ， 所 需 的 纵向 避 撞 距离 也 相应 减 小 ， 由 于 制 动 避 撞 距离 与 障碍 物 的 侧 向 偏 置 距离 无 关 ， 因 此 当 避 撞 所 需 的 侧 向 位 移 更 小 
时 ， 转 向 避 撞 具有 更 大 的 优势 ， 这 种 趋势 在 高 速 时 更 为 明显 。 转 向 同时 制 动 能 够 进一步 减 小 避 撞 距离 ， 但 这 种 趋势 随 着 所 需 侧 向 位 移 减 小 而 减弱 。 
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图 4-5 ”不同 侧 向 避 樟 距离 时 转向 及 转向 区 制 动 避 樟 所 需 的 纵向 距离 


从 以 上 分 析 可 知 ， 转 向 避 挤 在 高 速 、 低 重 直率 、 低 附着 系数 等 工 况 下 所 需 的 纵向 制 动 距离 比 制 动 训 挤 所 需 纵向 距离 要 短 ， 往 往 在 制 动 无 法 避免 磁 擅 
时 ， 通 过 转向 (或 转向 同时 制 动 还 能 够 避免 磁 樟 ， 因 此 引入 转向 控制 可 以 进一步 提高 避 挤 的 能 力 ， 
4.1 转 同 避 播 效能 及 可 行 性 分 析 


4.1.1” 避 撞 所 需 最 得 纵 同 距离 


驾驶 员 避 撞 的 方式 通常 有 制 动 、 转 向 以 及 制 动 同时 转向 三 种 ， 不 同 的 避 撞 方式 的 避 挤 效能 不 一 样 。 避 撞 效 能 的 不 同 主要 体现 在 避 撞 所 需 的 最 短 纵 向 距 
离 不 同 ， 如 图 4-1 所 示 。 本 书 将 对 这 三 种 避 撞 万 式 的 避 撞 效能 进行 分 析 ， 简 单 起 见 ， 本 节 玉 用 质点 车 辆 模型 进行 分 析 。 
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图 4-1 不 同 避 樟 方 式 所 需 的 纵向 避 撞 距离 
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图 4-2 车辆 质点 模型 


车 辆 在 XOY 坐 标 系 下 的 运动 微分 方程 为 : 
1 不 一 Fcos(y) -Fsin(y) 
时 0 | ) 
mY= Fsin(w) + F,cos(y) 


其 中 ，m 为 车 辆 质量 ， 由 为 车 辆 航向 角 ， 即 车 辆 坐标 系 x 轴 与 世界 坐标 系 X 轴 之 间 的 夹 角 ，Fx 和 Fy 为 实际 作用 在 车 辆 上 的 轮胎 力 。 


轮胎 力 Fx 和 Fy 受到 轮胎 摩擦 圆 的 约束 ， 因 此 ， 和 车 辆 的 加 速度 应 满足 如 下 关系 : 
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其 中 ，ax、ay 为 车 辆 的 纵向 和 横向 加 速度 ，ax，max、ay，max 是 车 辆 纵横 向 能 产生 的 最 大 加 速度 。ax，max=H9，bH 为 道路 摩擦 系数 ，g 为 重力 加 速度 。 
ay，max 受 到 道路 摩擦 系数 和 车 辆 抗 侧 翻 性 能 要 求 的 影响 ， 通 常情 况 下 ay, max<H9。 


V, =X, V,=Y 


引入 状态 变量 z，z= [X,Y，Vx，Vy] 1'，Vx、Vy 为 车 辆 沿 X 轴 和 Y 轴 的 速度 ， `。 车 辆 的 状态 方程 为 : 
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系统 输入 u= (Fx,， Fy) T。 设 驾驶 员 开始 避 撞 行 为 的 时 刻 为 0 时 刻 ， 车 辆 的 初始 状态 为 X (0) =Xo, Y (0) =Yo, Vy (0) =Vyo, Vx (0) =Vxo。 避 
撞 结 束 时 刻 为 T， 和 车辆 在 T 时 刻 的 状态 为 X (T) =XT, Y (T) =YT, Vy (T) =VYT，VXx (T) =VXKT。 为 了 求 最 短 纵向 避 撞 距离 ， 即 求 输入 u 使 得 XT 最 小 ， 设 
minX( 7) 


初始 时 刻 状态 变量 Yo=0，Vyo=0， 求 目标 函数 “ 

考虑 以 下 三 种 情况 : 

(1) 制 动 避 撞 ， 即 输入 Fy=0， 和 车辆 最 终 状态 YT=0，VXT=0。 

(2) 转向 避 撞 ， 即 输入 Fx=0， 车 辆 最 终 状态 YT= b，b 为 车 辆 避 撞 所 需 的 侧 向 距离 ，VYT=0， 即 车 辆 避 撞 完成 后 侧 向 速度 为 0。 

(3) 制 动 + 转向 避 撞 ，YT=b，VYT=0。 

设 车 辆 质量 m=1000kg， 道 路 摩擦 系数 Hb=0.8， 车 辆 避 撞 所 需 的 侧 向 距离 b= 3.0 米 ， 车 辆 最 大 纵向 加 速度 ax，max=0.8g， 不 考虑 侧 翻 ， 车 辆 最 大 侧 向 
加 速度 ay，max=0.8g。 采 用 Tomlab 的 PT Pro 软 件 计算 不 同 避 撞 方式 所 需 的 纵向 距离 中， 结果 如 图 4-3 所 示 。 可 以 看 出 ， 在 低速 时 ， 制 动 避 撞 所 需 距离 更 


短 ， 但 当 车 速 高 于 69.4km/h 时 ， 转 向 避 撞 所 需 的 纵向 距离 更 短 。 转 向 的 同时 制 动 能 够 进一步 减 小 纵向 避 撞 距离 ， 当 和 车速 高 于 59.6km/h 时 ， 制 动 + 转向 的 
避 撞 方式 所 需 纵向 距离 小 于 制 动 避 撞 距离 。 
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速度 (km/h ) 
图 4-3 ”纵向 避 樟 距离 (hu=0.8，b=3.0m) 


保持 其 他 条 件 不 变 ， 设 道路 摩擦 系 数 H= 0.3， 不 同 避 撞 方 式 所 需 的 纵向 避 撞 距离 如 图 4-4 所 示 ， 当 道路 摩擦 系数 降低 时 ， 转 向 避 撞 相对 于 制 动 避 撞 的 优 
势 更 为 明显 ， 当 和 车速 高 于 43.6km/h 时 ， 转 向 避 撞 所 需 的 纵向 距离 比 制 动 所 需 的 纵向 距离 更 短 ， 转 向 同时 制 动 能 够 进一步 减 小 避 撞 所 需 纵向 距离 ， 相 对 于 制 
动 避 撞 的 临界 车 速 为 38.1km/h。 
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图 4-4 ”纵向 避 撞 距离 (nu=0.3，b=3.0m) 


保持 道路 摩擦 系数 H=0.8， 设 转向 避 撞 所 需 的 侧 向 位 移 b 分 别 为 ?m，1.5m 和 0.5m， 三 种 情况 下 转向 避 撞 及 转向 同时 制 动 避 撞 所 需 纵向 距离 如 图 4-5 所 
示 。 当 如 撞 所 需 的 侧 向 位 移 减 小 时 ， 所 需 的 纵向 避 撞 距离 也 相应 减 小 ， 由 于 制 动 避 撞 距离 与 障碍 物 的 侧 向 偏 置 距离 无 关 ， 因 此 当 避 撞 所 需 的 侧 向 位 移 更 小 
时 ， 转 向 避 撞 具有 更 大 的 优势 ， 这 种 趋势 在 高 速 时 更 为 明显 。 转 向 同时 制 动 能 够 进一步 减 小 避 撞 距离 ， 但 这 种 趋势 随 着 所 需 侧 向 位 移 减 小 而 减弱 。 
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图 4-5 不同 侧 向 避 撞 距离 时 转向 及 转向 区 制 动 避 撞 所 需 的 纵向 距离 


从 以 上 分 析 可 知 ， 转 向 避 撞 在 高 速 、 低 重 亚 率 、 低 附着 系数 等 工 况 下 所 需 的 纵向 制 动 距离 比 制 动 避 撞 所 需 纵向 距离 要 短 ， 往 往 在 制 动 无 法 避免 碰撞 
时 ， 通 过 转向 (或 转向 同时 制 动 ) 还 能 够 避免 磁 撞 ， 因 此 引入 转向 控制 可 以 进一步 提高 避 撞 的 能 


4.1.2 不同 避 撞 廊 式 的 安全 收 葵 


有 无 智能 汽车 安全 系统 时 车 辆 的 状态 演变 如 图 4-6 所 示 ， 智 能 汽车 安全 系统 一 方面 可 以 通过 预警 提醒 特 驶 员 ， 帮 助 当 驶 员 回 避 础 撞 ; 另 一 方面 还 可 以 通 
过 主动 介入 自动 帮助 驾驶 员 回 避 人 碰撞 或 减轻 础 撞 的 程度 。 





当 驶 员 避 人 免 “、> 系统 避免 
\ 或 减轻 碰撞 或 减轻 碰撞 





车 辆 状态 空间 车 辆 状态 空间 
图 4-6 ”有 无 智能 汽车 安全 系统 时 车 辆 的 状态 演变 


因此 ， 从 事故 演变 的 角度 ， 智 能 汽车 安全 技术 的 最 直接 的 安全 收益 主要 来 自 于 两 方面 ( 见 图 4-7) ， 一 是 完全 避免 碰撞 ， 二 是 在 磁 撞 无 法 避免 时 减轻 碰 
撞 的 程度 。 磁 撞 减轻 也 有 两 种 途径 ， 像 AEB 系 统 主 要 是 通过 减 小 碰撞 前 后 的 速度 差 ， 也 就 是 Av 来 减轻 碰撞 的 程度 。 而 转向 控制 的 介入 使 得 改变 碰撞 位 置 和 
角度 成 为 可 能 ， 不 同 的 础 撞 位 置 和 碰撞 角度 造成 的 伤害 不 一 样 ， 因 此 碰撞 位 置 和 角度 的 适当 改变 也 可 以 起 到 碰撞 减轻 的 效果 。 
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图 4-7 安全 收益 的 三 种 方式 


为 计算 Av， 这 里 假设 碰撞 是 完全 塑性 碰撞 ， 即 碰撞 后 参与 碰撞 的 两 个 对 象 拥有 相同 的 速度 。 根 据 动 量 定理 ， 可 计算 任意 对 象 碰撞 前 后 的 速度 差 。 


对 于 车 -车 之 间 的 碰撞 ， 如 图 4-8 所 示 ， 础 撞 前 后 两 车 的 Av 为 : 








Av = Ie# -v= de v1 十 1 一 272 COSQ (4-4 ) 
| 十 1 

, -1 _ ue 2 ”2 . 

Ayv, 一 | Vv 一 已 | 一 / 歼 ] 下 Vv, 一 2Vv, COSQ (4-5) 





Mi I 


图 4-8 ”碰撞 示意 图 


AEB 系 统 主 要 是 针对 追尾 础 撞 ， 通 常情 况 下 车 -车 之 间 的 质量 相差 不 大 ， 因 此 这 里 假设 参与 碰撞 的 两 车 质量 相等 ， 则 两 车 的 Av 均 为 相对 础 撞 速 度 的 一 


对 于 图 4-8 中 的 车 与 行人 等 VRU 磁 撞 的 事故 ， 由 于 车 的 质量 比 行 人 大 得 多 ， 因 此 和 车辆 的 Av 可 设 为 0， 行 人 的 Av 等 于 车 辆 撞击 行人 的 速度 。 


从 Av 的 角度 看 ， 对 于 不 同 的 目标 物 ，Av 减 小 的 安全 收益 差别 很 大 。 对 于 追尾 事故 ， 图 4-9 为 退 尾 事故 中 后 车 及 前 车 乘员 受到 一 个 月 以 上 挥 引 伤 以 及 
MAIS2+ 以 上 伤害 的 概率 。AEB 控 制 策略 能 够 很 好 的 降低 ， 因 此 可 以 大 大 减 小 乘员 受伤 害 的 概率 。 
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图 4-9 ”追尾 事故 中 乘员 伤害 概率 曲线 


对 于 行人 等 VRU， 如 图 4-10 所 示 ， 昌 然 采 用 类 似 的 AEB 策 略 将 碰撞 速度 降低 到 40km/h 以 下 时 可 以 大 大 降低 行人 的 死亡 率 ， 但 是 受到 MAIS2+ 伤 害 的 概 
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图 4-10 ”行人 的 伤害 概率 曲线 中 


因此 ， 对 于 和 车辆 和 VRU 之 间 的 辜 撞 ， 避 撞 应 该 作为 主要 的 目的 ， 因 为 Av 减 小 市 来 的 安全 收益 并 不 明显 ， 而 对 于 车辆 之 间 的 碰撞 ，Av 减 小 市 来 的 辜 撞 减 
轻 能 够 相当 程度 的 降低 乘员 受伤 害 的 概率 。 考 虑 到 4.1.1 节 中 的 分 析 ， 转 向 避 撞 在 车 速 较 高 、 所 需 侧 向 位 移 较 小 时 相对 于 制 动 避 撞 的 优势 更 为 明显 ， 因 此 转 
向 避 撞 在 降低 VRU 死 亡 及 伤害 的 概率 上 具有 更 大 的 潜力 。 


另外 ， 通 过 碰撞 位 置 的 改变 也 可 以 获得 碰撞 减轻 的 效果 。 以 正面 碰撞 为 例 ， 布 泽 曼 (Buzeman) 等 人 通过 对 9902 起 涉及 沃尔沃 车 辆 的 正面 碰撞 事故 


进行 深入 分 析 ， 计 算 了 等 效 于 车 辆 塑性 变形 能 量 的 速度 ， 即 能 量 等 效 速 度 (Energy Equivalent Speed，EES) 【6] 。 


1 丰 
—mbEES = W, (4-6) 
2 ef 
其 中 ，Wpef 为 车 辆 塑性 变形 能 。 结 果 发 现 ， 当 EES 大 于 20mph ( 约 32km/h) 时 ，1/3 重 又 率 的 近 端 (Near) 正面 碰撞 造成 的 驾驶 员 及 乘员 受到 
MAIS2+ 和 MAIS3+ 的 概率 是 正面 全 宽 碰 撞 的 2 到 3 倍 (图 4-11) 【ol 。 因 此 ， 在 正面 碰撞 时 ， 应 当 尽量 避免 发 生 小 重重 率 碰撞 ( 见 图 4-11) 。 
2/3 重 香 
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图 4-11 不 同 重合 率 正面 碰撞 中 腾 员 受伤 害 概率 


综 上 可 知 ， 类 似 于 AEB 的 制 动 避 撞 控制 在 不 能 避 撞 时 ， 通 过 减 小 Av 来 达到 碰撞 减轻 的 目的 ， 对 于 车 -车 之 间 的 碰撞 能 够 有 效 降 低 乘 员 受 伤害 的 概率 ， 但 
对 于 车 与 VRU 之 间 的 碰撞 ，Av 减 小 市 来 的 安全 收益 较 低 ， 因 此 应 当 以 避 撞 为 主要 目的 。 行 人 尺寸 相对 于 车辆 小 很 多 ， 转 向 避 撞 所 需 的 侧 向 位 移 通常 情况 下 
也 较 小 ， 通 过 转向 避 撞 也 更 为 容易 ， 因 此 转向 避 撞 为 降低 对 VRU 的 伤害 提供 了 更 大 的 潜力 。 同 时 ， 在 碰撞 无 法 避免 时 ， 也 可 以 通过 转向 (或 差 动 制 动 ) 调 
整 碰撞 点 的 位 置 ， 避 免 友 生 小 重 妓 率 碰撞 ， 因 此 转向 控制 为 碰撞 减轻 也 提供 了 新 的 途径 。 


4.1.3 “不同 避 撞 方式 对 环境 感知 能 力 的 要 求 


忌 的 来 训 ， 像 AEB 系 统 只 控制 车 辆 速度 ， 因 此 只 需要 获得 目标 位 置 、 速 度 、 广 位 等 运动 信息 并 判断 目标 是 否 在 感 兴趣 区 域 (ROI) 内 ， 且 只 需要 考虑 危 


险 最 高 的 目标 。 


引入 转 同 控制 后 ， 速 度 控制 变 成 了 轨迹 控制 ， 根 据 当 前 车 速 和 可 能 的 避 撞 轨迹 ， 应 对 在 一 个 特定 空间 汽 围 内 的 多 个 相关 目标 进行 探测 和 识别 ， 包 括 这 
举目 标的 运动 状态 、 尺 寸 等 信息 。 同 时 ， 由 路 肩 、 车 道 线 、 道 路 中 静态 目标 等 构成 的 可 行驶 区 域 (Free Space) 也 应 该 通过 某 些 合适 的 传感器 进行 探测 。 


忌 的 来 讲 ， 实 现 转向 避 撞 控制 所 需 的 信息 大 大 增加 ， 大 致 可 以 轧 结 如 下 : 


:准确 可 靠 的 目标 探测 和 跟踪 (包括 静态 目标 〉。 
目标 相关 信息 。 

\ 距 离 〈 雪 150m) 。 

N 相 对 纵向 速度 。 

N 相 对 纵向 加 速度 。 

NY 相对 侧 向 距离 。 

N 相 对 侧 向 速度 。 

目标 宽度 。 

其 他 重要 信息 。 

N 侧 后 方 目标 及 运动 状态 。 





\ 道 路 等 级 及 几何 信息 。 

车 道 信息 。 

\ 本 车 运动 状态 信息 。 

\ 道 路 摩 探 系 数 。 

目前 没有 任何 一 个 单一 的 传感器 能 够 提供 上 述 所 有 信息 ， 因 此 需要 多 种 传感器 的 信息 融合 。 霍 姆 (Hohm) 等 人 通过 毫米 波 雷 达 和 双 目 摄像 头 的 信息 
融合 已 经 证 明 能 够 满足 自动 驾驶 所 需 的 环境 感知 需要 ， 自 然 也 能 够 满足 紧急 转向 控制 的 需要 。 未 来 高 精度 地 图 信息 、V2X 信 息 的 引入 可 以 进一步 提高 环境 
感知 的 广度 和 精确 度 。 


4.1.4 ”不 同名 境 方 式 对 执行 器 的 要 求 

对 于 AEB 系 统 ， 通 过 ESC 的 制 动 力 调制 可 以 很 容易 实现 所 需 的 车 轮 制 动力 ， 但 在 紧急 转向 控制 中 ， 由 于 引入 了 方向 控制 ， 需 要 对 和 车辆 的 转向 角 或 转向 
力矩 进行 调整 ， 因 此 由 如 下 几 种 执行 器 方案 可 供 选 择 【人 1 。 
1. 转 矩 执行 器 


以 电动 助力 转向 (EPS) 为 代表 ， 这 类 执行 器 可 以 产生 一 个 附加 转向 力矩 填 加 在 驾驶 员 的 输入 上 ， 和 驾驶 员 可 以 获得 直观 的 触觉 反馈 ( 见 图 4-12) 。 由 
于 快速 、 大 转 矩 介入 有 可 能 会 对 驾驶 员 的 手 造 成 伤害 ， 因 此 这 类 执行 器 通常 只 适用 于 长 时 间 、 低 水 平 的 介入 对 各 驶 员 转 向 行为 进行 修正 ， 但 不 适用 于 主动 
转向 。 





图 4-12 ”电动 助力 转向 (EPS) 


以 宝马 的 主动 前 轮转 向 (AFS) 为 例 ， 这 种 执行 器 在 驾驶 员 的 方向 盘 转 角 输 入 上 埃 加 一 个 转向 角 ( 见 表 4-13) 。 因 为 没有 附加 力 乱 ， 因 此 不 存在 对 各 
驶 员 手 造成 伤害 的 风险 ， 但 由 于 驾驶 员 输 入 与 车 辆 的 侧 向 运动 响应 之 间 的 相关 性 发 生 了 改变 ， 和 驾驶 员 无 法 获得 熟悉 的 力 有 反馈， 长 时 间 介 入 时 驾驶 员 可 能 会 
感到 不 适 ， 因 此 只 适用 于 短 时 间 、 局 水 平 介入 。 
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图 4-13 ”主动 前 轮转 向 (宝马 ) 


目前 还 处 于 研究 阶段 ， 后 轮 可 独立 于 前 轮转 向 ， 能 够 减 小 最 小 转向 半径 。 同 理 ， 由 于 雪 驶 员 得 不 到 融 悉 的 触 竞 反 饶 ， 因 此 也 只 适用 于 短 时 间 、 局 水 平 


通过 调制 单个 或 单 边 后 轮 的 制 动 力 可 以 产生 横 摆 力矩 ， 类 似 于 ESC 的 控制 原理 。 但 这 种 执行 器 的 介入 会 造成 速度 损失 ， 因 此 也 只 适用 于 码 时 间 的 介 
入 。 


通过 调制 左右 两 侧 的 驱动 力矩 也 可 以 产生 横 摊 力 矩 ， 可 以 通过 主动 差 速 器 实现 。 这 种 执行 器 也 只 适用 于 短 时 | 间 、 高 水 平 的 介入 。 


因此 ， 当 前 已 经 有 多 种 执行 器 能 够 满足 紧急 转向 避 撞 控制 的 需要 。 当 控制 的 目的 是 对 驾驶 员 的 转向 避 撞 行为 进行 矫正 ， 在 这 种 工 况 下 执行 器 输入 必须 
给 予 驾驶 员 和 直观 的 有 反馈， 同时 也 作为 人 机 交互 界面 (HMI) 向 驾驶 员 传递 转 癌 所 引 ， 最 直观 的 方式 是 通过 方向 盘 实 现 ， 因 此 更 适宜 采用 EPS 这 类 转 矩 执行 
器 。 如 果 控制 的 目的 是 目 动 紧急 转向 ， 在 这 种 情况 下 主动 前 轮转 向 、 后 轮转 同 、 制 动 调 制 等 可 以 产生 快速 且 强 度 足 够 的 介入 ， 能 够 显著 改变 车 辆 的 运行 轨 


迹 。 


本 书 在 4.1.1 节 中 对 制 动 避 撞 和 转向 避 撞 所 需 的 最 短 纵向 距离 进行 了 对 比分 析 ， 但 分 析 的 基础 是 基于 单 自由 度 质点 模型 的 ， 忽 略 了 车 辆 动力 学 特性 的 影 
响 ， 因 此 得 出 的 值 只 适用 于 定性 分 析 。 人 在 开 友 自动 各 驶 紧急 名 撞 控制 策略 时 ， 需 要 对 制 动 和 转向 所 需 的 最 短 纵向 距离 进行 准确 的 定量 分 析 ， 以 确定 在 特定 
的 工 况 下 某 种 避 撞 方式 是 否 可 行 ， 以 及 某 种 避 撞 方式 是 否 相对 于 另 一 种 避 撞 方式 更 有 优势 ， 这 些 分 析 结 果 是 危险 估计 的 基础 。 因 此 ， 本 节 将 对 制 动 和 转向 
避 撞 所 需 的 最 短 纵向 距离 进行 定量 的 分 析 。 

同时 ， 由 于 智能 汽车 安全 系统 的 作用 是 对 驾驶 员 提 供 辅助 ， 因 此 最 短 纵向 距离 分 析 应 当 是 结合 驾驶 员 的 行为 特性 ， 探 索 驾 驶 员 的 极限 状态 ， 在 驾驶 员 
由 于 生理 能 力 限 制 无 法 达到 避 撞 时 ， 只 要 还 在 车 辆 的 物理 极限 学 围 内 ， 还 可 以 通过 智能 汽车 安全 系统 帮助 驾驶 员 回 避 碰 撞 ， 因 为 电子 机 械 系 统 的 执行 能 


可 以 远 高 于 加 驶 员 。 


4.2.1 ” 制 动 所 需 的 最 短 纵 向 距离 


实际 危险 工 况 下 驾驶 员 的 制 动 行为 产生 的 车 辆 减速 度 如 图 4-14 所 示 ， 设 车 辆 初始 减速 度 为 a0， 和 驾驶 员 开 始 制 动 后 ， 由 于 制动器 的 延迟 ， 在 时 间 tg 后 车 
辆 的 制 动 减 速度 才 开 始 友 生变 化 ， 减 速度 以 梯度 jmax 达 到 最 大 制 动 减速 度 amax 并 保持 amax 不 变 直 到 车 辆 停止 或 成 功 避 免 碰 撞 。 


根据 对 驾驶 员 制 动 行 为 分 析 结 果 ， 虽 然 大 部 分 驾驶 员 不 能 充分 利用 车 辆 的 制 动 潜能 ， 但 驾驶 员 最 大 制 动 减速 度 绝对 值 的 90 百 分 值 在 0.8g 左 右 ， 说 明 仍 
然 有 部 分 驾驶 员 达 到 了 车 辆 的 最 大 制 动 减 速度 。 为 了 避免 误 作 用 ， 这 里 设 定 驾驶 员 制 动能 够 达到 的 最 大 制 动 加 速度 与 车 辆 能 够 达到 的 最 大 制 动 减 速度 一 
致 。 而 95% 的 驾驶 员 制 动 梯度 小 于 20.82m/s3， 因 此 设 定 加 速度 梯度 jy=21my/s<。 


制动器 延迟 时 间 td 随 看 后 辆 的 不 同 而 不 同 ， 但 很 多 制 动 辅助 系统 在 区 驶 员 未 开始 制 动 时 已 经 进行 了 蕾 压 ， 可 以 将 td 减 小 到 0， 因 此 这 里 设 定 td=0。 同 
时 假设 目标 车 静止 ， 本 车 制 动 停止 后 与 目标 车 的 安全 容量 SM=0.1m， 道 路 摩擦 系数 H=0.8， 本 车 能 够 达到 的 最 大 制 动 减速 度 绝对 值 amax=hg， 初 始 制 动 减 
速度 a0=0， 本 车 初始 速度 为 v0。 


--------- i 





时 间 (s) 
图 4-14 驾驶 员 制 动 输入 示意 图 
当 车 速 很 低 时 (小 于 5.3km/h) ， 车 辆 还 未 达到 最 大 制 动 减速 度 时 车 辆 就 已 经 停止， 这 种 情况 下 本 车 危险 性 较 低 ， 因 此 不 做 考虑 ， 则 : 


1 


L ee [47) 
Rn 
vo 一 三 MD 
记 = 0 ii ] (4=8) 
Cnax 
1 . :3 ] 2 

Vol 和 nl 0 了 Cmaxl2 (4-9) 
sp= $+ SM (4-10) 

Eh re Sa Vo (4- 11 ) 


其 中 ，t1 为 达到 最 大 制 动 减 速度 所 需要 的 时 间 ，t2 为 从 达到 最 大 制 动 减速 度 到 和 车辆 停止 的 时 | 间 ，TTCceritical 为 临界 TTC 值 。 图 4-15 为 不 同 车 辆 初速 度 下 
的 临界 距离 值 ， 由 此 可 见 考 虑 和 不 考虑 减速 度 梯度 时 临界 制 动 距离 的 差异 随 着 车 速 的 升 高 而 增 大 ， 在 本 车 车 速 为 100km/h， 两 者 之 间 的 差异 达到 5.51m， 
啊 应 的 临界 TTC 值 差异 达到 0.20s ( 见 图 4-16) ， 在 紧急 工 况 下 这 0.20s 的 郑 异 会 市 来 很 大 的 不 同 。 
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图 4-15 ”临界 制 动 距离 图 
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图 4-16 ” 制 动 避 撞 的 临界 TTC 值 


4.2.2” 转 同 避 撞 所 需 的 最 得 纵 同 距离 


比 拉 尔 (Biral)” [8] 、 贝 尔 托 拉 齐 (Bertolazzi) ”1 等 人 的 研究 结果 表明 ， 驾 驶 员 在 规划 转向 路 径 时 大 致 可 用 最 优 控制 进行 描述 ， 即 遵循 “最 大 方 
向 盘 转速 最 小 (Minimum Jerk) ”的 原则 ， 让 驾驶 过 程 尽量 平滑 。 因 此 ， 本 书 采用 最 优 控制 方法 模拟 驾驶 员 的 转向 避 撞 行为， 分析 驾驶 员 转 向 避 撞 所 需 
的 最 短 纵 向 距离 ， 同 时 也 作为 转向 避 撞 路 径 规划 的 基础 。 


不 失 一 般 性 ， 考 虑 如 图 4-17 所 示 的 前 车 静止 工 况 ， 将 两 车 都 视 作 相同 大 小 矩形 ， 长 为 5.2m， 宽 2.0m， 两 车 重 芍 率 为 100%。 和 车辆 质心 到 车 辆 最 前 端的 
距离 为 2.5m， 到 和 车辆 最 后 端 中 离 为 2.7m。 





图 4-17 ”转向 避 挤 示意 图 


1. 车 辆 模型 


为 了 获得 更 为 准确 的 结果 ， 这 里 及 用 二 上 自由 度 单轨 和 车辆 模型 ， 状 态 变 量 为 质心 侧 偏 角 B 和 横 摆 角速度 y。 由 于 转向 避 撞 过 程 时 间 很 得 ， 且 为 了 保持 车 辆 


避 撞 后 的 机 动 性 需 尽 量 减少 速度 损失 ， 因 此 这 里 设 车 速 恒定 为 ug0o， 即 不 考虑 制 动 的 影响 。 车 辆 的 状态 方程 为 : 


mu (B + y) = 2F, +2F, 


总 


Ly= 21P -2LF, (4-12) 


其 中 ，m 为 车 辆 质量 ,12 为 车 辆 绕 z 轴 的 转动 惯量 ，lf 趟 示 和 车辆 质心 到 前 轴 的 距离 ，l1| 表 示 质 心 到 车 辆 后 轴 的 距离 。Fxf{、Fyf 表 示 单 个 表 轮 的 轮胎 力 在 车 
辆 坐标 系 下 的 分 量 。 由 于 不 考虑 车 轮 的 左右 载 丛 转移 ， 因 此 左右 两 个 车 轮 的 轮胎 力 相 等 。 同 理 ，Fxr、Fyr 表 示 蛙 个 后 轮 的 轮胎 力 在 车 辆 坐标 系 下 的 分 量 。 


Fyf、Fyr 根 据 车 轮 纵向 力 和 侧 向 力 转换 得 到 : 
Fyi=fxiSin (5i) +fyicos (5i) (4-13) 


其 中 ，iE{f,， nn},， 分 别 表示 前 轮 和 后 轮 ，6i 表 示 和 车轮 | 的 转向 角 ， 本 书 中 假设 车 辆 只 有 前 轮转 同 ， 因 此 56r=0。 同 时 ， 由 于 6f 很 小 ， 上 式 可 信 化 为 : 


Fyf=fyicos (5f) 





Ffyr: Cd-14) 


根据 Pacejka 轮 胎 模型 ， 轮 胎 侧 向 力 fy 可 以 看 作 是 轮胎 侧 偏 角 、 道 路 摩擦 系数 以 及 轮胎 法 向 力 的 函数 ， 即 轮胎 侧 向 力 fy 可 以 写成 如 下 形式 : 


fyi=fc (Qi, Mi, Fzi) (4-15) 
其 中 ，iE{f，r}，qj 表 示 轮 胎 i 的 侧 偏 角 ，bi 是 道路 轮胎 处 的 道路 摩擦 系数 ，Fz 表 示 轮 胎 i 的 法 向 力 。 


假设 左右 两 侧 轮 胎 侧 偏 角 相 等 ， 则 前 后 轮 的 轮胎 侧 偏 角 为 : 


= = 


| (4-16) 
L,Y 


Un 





a,=b- 
轮胎 的 法 向 力 Fz 受 到 车辆 质量 分 布 和 车 辆 加 速度 等 的 影响 ， 简 单 起 见 ， 这 里 假设 轮胎 法 向 力 恒定 ， 只 由 车 辆 的 稳 态 质量 分 布 属性 决定 ， 即 : 
rs ig 
af" 
: bot, 


na Li 
- ls + bh 


(4-17) 


将 车 辆 坐标 系 变量 转换 到 大 地 坐标 系 : 


X= xcos(y) — ysin( vy) 


uol cos(wW) - Bsin(y) | 
y = xsin(wW) + yecos(vy) uol sin(w) + Beos(y)) (4-18) 


y= 


其 中 ，X、Y、 由 为 车 辆 在 大 地 坐标 系 中 沿 X 轴 的 位 置 、 沿 Y 轴 的 位 置 以 及 航向 角 。 同 时 ， 为 了 引入 转向 角速度 Y 的 约束 ， 此 处 将 6f 视 作 状 态 变量 ,得 
到 车 辆 的 状态 万 程 为 : 


EC) =f [EC (4=19) 
其 中 5= [B,，y，,，J， X,Y，6f] ， 输 入 u=6f， 假 设 道路 摩擦 系数 为 已 知 的 外 部 参数 。 


2. 安 全 约束 


如 图 4-18 所 示 ， 车 辆 质心 在 大 地 坐标 系 中 坐标 为 (X，Y) ， 航 向 角 为 小， 车 辆 质心 到 车 辆 最 前 端 距离 为 f， 到 车 辆 最 后 端 距离 为 L/， 和 车 辆 宽度 为 W， 
则 车 辆 四 个 角 点 的 坐标 为 : 


X= AX +Leos(y) - sin(w) 


I 
|| 


Y + Lsin(w) 十 7 COs) 


>< 
|| 


X+Leceos(y) + sin (水 ) 


WW 
Yj = YY + bsin(y) -Scos(y) 


X= -Leos(y) - Fsin(y) (4-20) 


,=Y—-Lsin(y) 十 Fcos(y) 


< 
|| 


X—Lcos(y)+ sin(Y) 


>< 
[ 


qe 
|| 


,= Y -Lsin(y) - Fcos(y) 


其 中 人 f，rf，lr，mmn 分 别 代表 左前 、 右 前 、 左 后 、 右 后 四 个 角 操 。 





图 4-18 安全 约束 示意 图 


在 转向 避 撞 时 ， 车 辆 必须 保持 在 规定 的 道路 上 ， 则 必须 满足 : 
max (Y]f, Ylr) <Ymax 


mi (Ye Ye Ymin “C4=21) 


其 中 ，Ymax、Ymin 为 道路 的 上 下 边界 ， 由 道路 边缘 、 路 肩 、 护 栏 等 决定 。 


驾驶 员 在 转向 避 撞 时 车 辆 的 侧 向 加 速度 不 能 超过 一 定 的 限 值 ， 过 高 的 侧 向 加 速度 一 来 会 引起 驾驶 员 的 不 适 感 ， 二 来 可 能 会 导致 车 辆 失 稳 ， 因 此 侧 向 加 
速度 必须 满足 | ay | <ay, Max Bp: 


uw(B+y)| a, (#22) 


ay，max 由 道路 摩擦 系数 、 和 车 辆 的 抗 侧 翻 能 力 、 和 驾驶 员 生 理 限制 等 决定 ， 通 常情 况 下 ay，max<hg。 


如 图 4-19 所 示 ， 为 了 达到 避 撞 的 目的 ， 以 向 左 转向 避 撞 为 例 ， 在 本 车 通过 目标 车 时 ， 目 标 车 左 后 角 上 后 (XO，YO) 到 本 车 右 侧 边 界 的 距离 D 必 须 大 于 一 


定 的 安全 距离 PSM， 即 : 


kX,— YY, +Y,.— kX 
je (4-23) 


rae 呈 帮 


其 中 k 为 本 车 右 侧 边界 所 在 直线 的 斜率 , k=tan (中 ) 。 








图 4-19 


3. 执 行 器 约束 


在 


bE ] < Of nas 


16, | < Of max 


将 安全 约束 和 执行 器 约束 综合 在 一 起 ， 可 以 用 下 式 进 行 表示 : 

pCECt), u(t), t) <0 (4-26) 

其 中 ，5 (t) 为 车 辆 状态 变量 
的 非 负 常数 ， 得 到 |: 

p ECt), u(t), t) <1s 

eg 


4. 最 优 控 制 问题 


最 优 控制 问题 的 目标 销 数 用 下 式 表示 : 


Jiu( *)) 


其 中 ，to 表 示 起 始 时 刻 ，tf 表 示 终 止 时 刻 ， 等 
程 目 标 函 数 ， 目 的 是 让 整个 控制 过 程 的 状态 或 输入 满足 一 定 的 性 能 指 





| 
0 TTC 


~ i 


\ 


避 撞 约束 示意 图 


通过 紧急 转向 进行 避 撞 时 ， 由 于 和 车辆 的 结构 以 及 驾驶 员 的 生理 能 力 的 限制 ， 转 向 角 和 转向 角速度 都 不 能 超过 一 定 的 限 值 ， 即 : 


(4-24) 


SLC ,0] + | Léast) dt 


标 ， 也 称 Lagrange 型 目标 消 数 。 


S| 


二 


1 nih 


(4-25) 


，U (t) 为 车 辆 输入 。 为 了 保证 使 计算 的 稳定 性 最 优化 ， 此 处 对 和 车辆 可 行 域 约束 条 件 进行 松弛 ， 松 弛 变量 为 e，e 为 很 小 


(4-28) 


等 号 右边 第 一 项 表示 终 值 目标 溺 数 ， 目 的 是 让 终 值 更 为 接近 目标 集 ， 也 称 Mayer 型 目标 辫 数 。 第 二 项 表示 过 


本 书 将 转向 避 撞 过 程 分 为 两 个 阶段 ， 第 一 个 阶段 起 始 时 刻 to1=0， 终 止 时 刻 tf1=TTC， 第 二 个 阶段 起 始 时 刻 toz=TTC， 终 止 时 刻 tf2 不 加 限制 。 


第 一 个 阶段 的 目标 遂 数 为 : 


J = woD(tn) + E | waB(t) dt + ws6(t) dt + w(t) dt] (4-29) 


01 !01 
WD 为 终止 目标 消 数 加 权 系数 ，D (tf1) 为 终 值 时 刻 目标 车 堪 后 角 点 到 本 车 石 侧 边 界 的 距离 ，wpg 为 质心 侧 偏 角 目 标 消 数 加 权 和 系数， 该 值 越 大 表示 整个 
(US 
转向 避 撞 过 程 越 平缓 ，wsf 及 ”“/ 分 别 为 转向 角 和 转向 角速度 的 目标 函数 加 权 系 数 。 


第 一 个 阶段 的 边界 条 件 为 : 


= 
A 
= 和 
a 
|| 
CN 


X(to) = 

Y(to) = 

(to ) = 

6,(t0) = free (4-30) 
tn = TIC 


B( bn ) = free 
y(tn) = free 
Jt) = free 


Xi) = free 
Y(1,,) = free 
(tj1) = free 
6/(tp1) = free 


在 tf1 时 刻 ， 除 了 满足 安全 约束 、 执 行 器 约束 以 外 ， 目 标 车 辆 左 后 角 点 到 本 车 右 侧 边 界 的 距离 D (tf1) 要 满足 以 下 事件 约束 : 


hk Ao -Yo +t Ytn) — kX) 


D( bi ) 一 Dsy (4-31 ) 
/] +k 
nl 
其 中 ktf1=tan (yw (tf1) ) 。 
第 二 个 阶段 的 目标 函数 为 : 
1f2 . 
J = we | waB(D dt + wd/(t) dt + wad/(t) dt (4-32) 
OF 02 
其 中 ，w{ 为 终 值 目标 辫 数 加 权 系 数 ， 值 越 大 表示 要 求 tf2 越 小 。 
第 二 个 阶段 的 初 值 边 界 条 件 与 第 一 个 阶段 的 终 值 边 界 条 件 相 同 ， 第 二 个 阶段 的 终 值 边 界 条 件 为 : 
ty = free 
Bltn)=0 
y(tn)=0 
f(t) = 0 (4-33) 
X(t») = free 
(ts) ST 
6(tn)=0 
6(tn)=0 


其 中 ，Yref 为 期 望 侧 向 位 移 。 


本 书 采 用 高 斯 伪 谱 法 求解 该 最 优化 问题 ， 将 上 述 过 程 转换 为 以 下 最 优 控制 问题 : 


min J = SLE() 六] + [ Lg) (4-34) 


s. +, 


A a 


op[é(t) ,u(t),t,e] 0 


2 三 有 
CI (ti) | = 0 
te lio,t) 


J 时 
状态 变量 5= [BB，y， 由 ，X，Y，6f] ， 控 制 输入 / 。 由 于 高 斯 伪 谱 法 的 分 配点 (Collocation Point) 都 分 布 在 [-1，1] 的 区 间 ， 因 此 将 时 间 
区 间 tE [to，tf] 转换 成 Te [-1，1] ， 对 时 间 t 做 如 下 变化 : 





人 Sa 


则 上 述 最 优 控 制 问 题 可 转换 为 : 
Tf 
min J = S|é( 77) | + | L(é wm ritot) dr (4-30 ) 
70 
3 二 


Ly 一 了 0 


£(#) ; [| 





“ACoA 


Ee 宇 0 
Cl é(70) ,to CTr) ,ty| =0 
Te[-1,1| 
然后 选取 N 个 Legendre-Gauss-Radau (LGR) 点 ， 同 时 取 初 始点 tr0=-1， 总 共 N+1 个 节点 构造 N+1 个 Lagrange 插 值 多 项 式 L; (Tt) (i=0, 1, 


…，N) ， 并 以 这 些 多 项 式 为 基 消 数 对 状态 变量 56 进行 近似 计算 ， 得 到 |: 
N 

é(7) ~ BE(7) = DL(7)E(7,) (4-37) 
b= 


其 中 ，Lagrange 插 值 多 项 式 L; 人) 为 : 


Ny 
z ra 
ee J 
L(7) = TT 一 一 (4-38) 
17=0,7A1 二 1 
同时 ， 在 节点 处 ， 状 态 变量 近似 值 应 与 实际 状态 变量 值 相等 ， 即 满足 以 下 表达 式 : 


… ， N) 


A 起 -| 
同样 ， 采 用 Lagrange 插 值 多 项 式 (Tt ， N) 作为 基 消 数 对 控制 输入 u 进 行 近似 计算 ， 得 到 |: 


u(r) U(r) = UL (4-40) 





| ， ， ， N) 
其 中 im 为 LGR 点 。 


接着 对 式 (4-37) 求 导 ， 得 到 状态 变量 的 导数 ， 从 而 将 动力 学 约束 微分 方程 转换 为 代数 约束 ， 即 : 


E(7) ~ (7) = PLT)ET) = PDB(7) (4-41) 


万 Ee 和 

其 中 .中 为 微分 炬 阵 ， 在 插值 节点 个 数 确定 后 其 值 为 常 值 ， 即 : 
MN 
N | 收 吕 T;) 
a 7=0 714 | 
Pu(Tt) = LT7) = 入 OT (4-42 ) 
上 三 心 
j=0,7 1 

其 中 ，Ttk (k=1，2，…，N) 为 集合 k 中 的 点 ， 而 Ti (i=0，1，...，N) 属于 集合 ko={to，T1，.…，TN}。 利 用 式 (4-41) 代替 式 (4-36) 中 的 车 辆 动 


力学 约束 方程 ， 并 在 插值 节点 tk (1<k<N) 处 进行 离散 ， 可 将 最 优 控 制 问 题 的 车 辆 动力 学 微分 方程 转换 为 代数 约束 ， 对 于 Kk=1，2，...，N， 有 : 





N J 
> DB(R Ys ; Sf[ ST) ,UT) ,ri 省] = 0 (4-43) 
i=0 


式 (4-43) 并 未 对 终止 时 刻 (tf=1) 时 的 状态 变量 =f 进 行 定 义 ， 按 照 车 辆 动力 学 方程 ， 终 止 时 刻 的 状态 变量 应 满足 : 
] 
E(7) = é(70) + | AIE(r),a(r),r]dr (4-44) 


将 该 约束 条 件 进 行 离散 并 用 高 斯 积分 近似 表示 ， 得 到 : 


HI 


_ A a 
(rr) = 号 (ro) + Dof [ET) Cr ,Tisto,ty] (4-45) 


k=]1 


1 
w, = | Li(7) 区 


其 中 ， 为 高 斯 权重 ，Ttk 为 LGR 点 。 


同 理 ， 对 式 (4-36) 中 的 路 径 约 束 和 边 值 约束 在 插值 点 进行 离散 ， 可 得 到 |: 


p[ S(T.) ,UCT,) Tyo Bs to ,ty) 三 (0 


tlé(7o) ,to Te ,ty = 0 


(4-46) 


经 过 上 述 变换 ， 和 车 辆 转向 避 撞 的 最 优 控制 问题 可 转换 为 非 线 性 规划 问题 ， 本 书 中 采用 GPOPS 软 件 进 行 求解 【10] 。 


比如 ， 设 本 车 车 速 uo=70km/h， 车 辆 质心 到 车 辆 最 前 端 距离 为 /=2.5m， 到 车 辆 最 后 端 距离 为 Lj=2.7m， 车 辆 宽度 为 W=2.0m， 车 道 宽 度 为 
3.5m，Ymin=-1.752m，Ymax=5.25m，Yref=3.5m， 即 转向 避 撞 后 目标 侧 向 位 置 为 旁 车 道中 心 线 ， 道 路 摩 探 系数 H=0.8， 最 大 侧 向 加 速度 ay，max=0.69， 
最 大 方向 盘 转角 8driver max=180” (虽然 方 向 盘 最 大 转角 远大 于 180"， 但 我 们 参阅 众多 文献 发 现 ， 在 紧急 转向 避 撞 时 ， 几 乎 所 有 驾驶 员 的 方向 盘 转角 输入 


> = 500°/s 
都 在 180" 以 下 ) ， 最 大 方向 盘 转速 O ier mas “， 方 向 盘 与 转向 轮 之 间 的 转向 比 为 it= 18.25， 即 最 大 转向 角 5f max=5driver maxVist， 最 大 转向 
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一 On CO 0 f 


Dn st i 二 
角速度 “ 。 安 全 裕 量 距离 DsM=0.1m， 初 始 时 刻本 车 与 目标 车 的 TTC=1.0s。 取 wp=0.8，wpg=1.0，wsf=0.001, 
，Wwf=1.0。 求 解 最 优 控 制 问题 ， 得 到 的 车 辆 轨迹 及 相应 的 状态 变量 历程 如 图 4-20 所 示 。 
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图 4-20 转向 避 樟 轨 还 


备 界 值 随 着 车 


在 一 定 类 型 工 况 下 ，TTCI 


可 以 看 出 ， 
这 使 得 通过 转向 避 撞 更 容易 ， 


全 \。 


结果 如 图 4-21 所 


而 增 大 ， 


计算 不 同 车 速 下 的 转向 避 撞 所 需 TTC 的 临界 值 ， 最 


空 制 算法 ， 


采用 上 述 最 优 # 


达到 一 定 


因此 TTCI 临 界 值 减 小 。 


因为 最 大 侧 向 加 速度 以 及 侧 向 加 速度 梯度 都 随 着 车 速 的 升 高 


夺 | 
人 AE 


加 


这 
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速 的 升 高 而 降低 ， 


此 TTC 临 界 值 不 再 变化 ，。 


同 加 速度 梯度 都 饱和 ， 


| 


从 


度 以 及 


最 大 侧 同 


速度 后 了 


将 制 动 避 撞 以 及 转向 避 撞 所 需 的 临界 TTC 值 绘制 在 一 起 ， 如 图 4-22 所 示 ， 在 相对 车 速 较 低 (小 于 43.05km/h) 时 ， 制 动 避 撞 的 临界 TTC 值 比 转向 避 撞 
所 需 的 TTC 临 春 值 低 ， 因 此 自动 紧急 制 动 系统 AEB 系统) 在 相对 和 车速 较 低 时 是 一 个 最 优 的 选择 ， 因 为 此 时 通过 转向 无 法 避免 碰撞 。 


当 相 对 车 速 较 高 时 (大 于 43.05km/h) ， 转 向 避 撞 所 需 的 TTC 临 界 值 更 低 ， 说 明 此 时 虽然 制 动 无 法 避免 磁 撞 ， 但 通过 转向 还 能 够 避免 磁 撞 ， 因 此 紧急 
转向 控制 在 相对 和 车速 较 高 时 相 比 于 紧急 制 动 控制 可 以 提供 更 好 的 避 撞 效果 。 


在 碰撞 无 法 避免 区 域 ， 传 统 的 AEB 系 统 通过 自动 制 动 减 小 Av 来 减轻 碰撞 的 程度 ， 在 引入 转向 控制 后 ， 如 4.1.2 节 中 所 述 ， 还 可 以 通过 调整 碰撞 点 的 位 置 
和 角度 进一步 降低 碰撞 的 严重 程度 。 基 于 制 动 和 转向 协调 控制 的 碰撞 减轻 策略 是 后 一 阶段 研究 的 重点 ， 本 书 中 不 做 详细 前述 。 


在 道路 摩擦 系数 不 同 ， 重 亚 率 不 同时 ， 制 动 避 撞 与 转向 避 撞 所 需 的 TTC 临 界 值 对 比如 图 4-23 所 示 。 可 见 当道 路 摩擦 系数 从 0.8 降 低 到 0.3 时 ， 临 界 相对 
速度 从 43.05kmyh 降 低 到 24.73km/h， 说 明 在 湿 滑 路 面 上 ， 转 向 避 撞 相对 于 制 动 避 撞 的 优势 更 大 。 保 持 道路 摩擦 系数 为 0.8 不 变 ， 本 车 与 目标 车 的 重 丢 率 从 
100% 降 低 到 50% 时 ， 临 界 相对 速度 从 43.05kmyh 降 低 到 34.84kmy/h， 说 明 在 重 亚 率 较 小 时 ， 转 向 避 撞 的 有 效 性 更 高 . 


-转向 避 撞 极限 (x = 0.8, 100 允 覆盖 ) 





车 速 (kmh) 


图 4-21 不 同 车 速 下 转向 避 撞 所 需 的 临界 TITC 值 (hn=0.8，100%overlap) 
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图 4-22 ”临界 TTC 值 对 比 (4 


40 


0.8，100%oovetlap ) 


转 回 避 撞 极限 〈w=0.8, 100 允 履 羡 ) 
转向 避 撞 极限 (y=0.3, 100%% 履 盖 ) 
转 回 避 措 极限 〈A=0.8, 50 宛 履 盖 ， 
-一 一 一 制 动 导 撞 极限 (j=0.8 ) 
制 动 导 撞 极限 (w=0.3 ) 
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60 
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图 4-23 ”不同 工 况 下 制 动 避 撞 和 转向 如 撞 所 需 的 TTC 临 界 值 


4.3” 目 动 罕 护 控制 


本 书 采 用 转向 控制 进行 紧急 避 撞 ， 与 传统 的 AEB 策 略 一 起 构成 自动 驾驶 紧急 避 撞 控制 。 目 前 国际 上 已 经 开始 对 紧急 转向 辅助 控制 进行 研究 ， 这 些 研 究 
大 致 可 以 分 为 以 下 三 类 [7] : 


(1) 驾驶 员 触 友 型 紧急 转向 辅助 系统 。 
(2) 矫正 型 紧急 转 疝 辅助 系统 。 
(3) 目 动 型 举 急 转向 辅助 系统 。 


各 驶 员 触 友 型 紧急 转向 辅助 系统 是 指 在 上 紧急 工 况 下 ， 如 果 鸭 驶 员 开 始 转向 避让 行为 ， 系 统 目 动 对 驾驶 员 的 转向 避 撞 行为 进行 辅 肋 。 这 种 系统 需要 区 分 
轰 驶 员 是 正音 的 变 道 行为 还 是 紧急 转向 避 撞 行为 ， 这 可 以 通过 分 析 雪 驶 员 的 方向 盘 转速 实现 。 系 统 对 忽 驶 员 提 供 辅助 时 ， 可 以 通过 在 方向 盘 上 加 一 定 的 力 
矩 辅助 和 引导 笃 驶 员 沿 着 特定 的 轨迹 行驶 避 开 碰撞 。 出 于 法 律 问题 考虑 ， 系 统 必 须 允 许 驾驶 员 在 任何 时 候 取消 掉 系 统 的 介入 。 由 于 是 驾驶 员 开 始 的 转向 吉 
撞 行 为 ， 因 此 系统 假设 驾驶 员 已 经 知道 避 撞 路 径 上 是 否 有 其 他 交通 参与 者 或 障碍 物 ， 系 统 不 需要 检测 这 些 信息 。 这 种 形式 的 转向 辅助 相对 保守 ， 但 不 存在 
法 律 责 任 间 题 ， 因 此 也 是 离 产 品 最 近 的 一 种 方式 。 但 这 种 系统 在 驾驶 员 无 转 同行 为 时 不 会 自动 转向 ， 因 此 也 降低 了 转向 避 撞 的 安全 效能 。 


矫正 型 紧急 转向 辅助 系统 在 前 方 有 骑 车 人 、 路 旁 延 伸 到 本 车 车 道中 的 障碍 物 、 行 人 横 穿 车 道 等 工 况 下 目 动 转向 帮助 驾驶 员 避 免 磁 撞 。 在 这 些 工 况 下 转 
向 避 撞 所 需 的 侧身 位 移 较 小 ， 因 此 奉 出 现 误 报 友 生 严重 后 果 的 可 能 性 较 小 。 这 种 系统 通 弟 只 在 驾驶 员 通 过 制 动 无 法 避免 碰撞 时 才 介 入 ， 在 介入 过 程 中 需要 
确保 千 辆 不 会 与 其 他 交通 参与 者 或 障碍 物 友 生 人 础 撞 。 


目 动 型 紧急 转向 辅助 系统 通常 在 备 驶 员 既 无 制 动 也 无 转向 避 撞 行为 时 ， 在 最 后 能 够 避 撞 的 时 刻 上 自动 局 动 罕 急 转向 避 撞 操作 。 这 种 系统 在 避 撞 时 所 需 的 
侧 向 位 移 以 及 行驶 空间 根据 当前 交通 环境 确定 ， 因 此 能 够 应 对 多 种 不 同 的 交通 工 况 。 但 这 种 系统 必须 对 和 车辆 周边 的 运行 环境 进行 广泛 、 细 致 且 准 确 的 感 


知 ， 需 要 确保 在 系统 介入 过 程 中 车 辆 不 会 与 其 他 交通 参与 者 或 障碍 物 友 生 磁 撞 。 


自动 型 紧急 转向 辅助 系统 能 够 最 大 程度 地 利用 车 辆 的 避 撞 潜力 ， 因 此 具有 最 高 的 安全 效能 。 但 海 塞 等 人 通过 驾驶 模拟 测试 发 现 ， 如 果 和 驾驶 员 没 有 转向 
行为 但 系统 自动 局 动 坚 急 转 向 时 ， 几 乎 所 有 的 驾驶 员 都 会 紧 握 方向 盘 甚 至 向 转向 介入 的 相反 方 同 转向 ,很 大 程度 上 削弱 了 上 自动 转向 避 撞 的 效果 [115] 。 
为 了 克服 驾驶 员 下 意识 的 抑制 转向 介入 的 行为 ， 海 塞 (Hesse) 等 人 设计 了 方向 盘 短 暂 解 看 的 介入 方式 ( 见 图 4-24) ， 在 TTC=1.6s 时 自动 转向 介入 ， 在 接 
下 来 的 0.5s 时 间 内 ， 通 过 线 控 转 向 实现 方向 盘 解 厢 ， 系 统 忽 略 驾 驶 员 的 所 有 转向 输入 ， 在 接 下 来 的 0.3s， 方向 盘 仍 然 解 辜 ， 但 驾驶 员 可 以 通过 反 转 万 向 盘 与 
车 辆 重新 耦合 ， 在 介入 0.8s 乙 后， 系统 作用 终止 ， 驾 驶 员 的 输入 与 后 辆 重新 看 合 。 
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图 4-24 ”驾驶 员 解 坷 的 自动 转向 控制 


测试 结果 表明 ， 通 过 驾驶 员 解 耦 可 以 在 很 大 程度 上 避免 驾驶 员 下 意识 的 转向 抑制 行为 对 转向 避 撞 效能 的 影响 。 但 当 出 现 误 作用 时 ， 系 统 可 控 性 
(Controllability) 变 差 ， 所 有 驾驶 员 都 不 能 将 车 辆 的 侧 向 位 移 控制 在 0.85m 内 ， 即 车 辆 都 越 出 了 本 车 车 道 ， 这 可 能 会 带 来 严重 的 后 果 。 


因此 ， 考 虑 到 对 于 系统 避 撞 效能 和 可 控 性 之 间 的 矛盾 仍然 没有 一 个 合适 的 解决 方案 ， 本 书 主要 采用 驾驶 员 触 帮 型 紧急 转向 辅助 系统 ， 只 有 当 目标 物 是 
行人 、 骑 后 人 等 易 受 伤害 的 道路 使 用 者 (VUR) 或 者 转 癌 避 撞 所 需 的 侧身 位 移 较 小 ， 车 辆 可 以 在 本 车 道内 完成 转向 避 撞 行为 时 ， 才 采用 策 正 型 紧急 转 内 辅 
助 系统 。 


4.3.1 ”驾驶 员 触 友 型 紧急 转向 辅助 控制 


以 追尾 危险 工 况 为 例 ， 虽然 在 相对 速度 较 高 时 转向 避 撞 的 效能 要 高 于 制 动 避 撞 ， 但 由 于 在 该 类 工 况 下 转向 避 撞 所 需 的 侧 向 位 移 较 大 ， 通 常 需要 占用 旁 
车 道 才能 完成 避 撞 操作 ， 出 于 责任 和 可 控 性 的 考虑 ， 本 书 中 采用 驾驶 员 触 友 型 紧急 转向 辅助 控制 ， 控 制 策略 如 图 4-25 所 示 。 在 检测 到 驾驶 员 有 转向 避 撞 行 
为 时 首先 判定 是 否 存 在 转向 避 撞 空间 以 及 是 否 可 以 避 撞 ， 同 时 检测 AEB 系 统 是 否 已 经 介入 。 与 4.2 节 中 的 内 容 不 同 ， 此 处 考虑 车 辆 的 物理 避 撞 极限 ， 由 于 执 
行 器 可 以 提供 比 驾 驶 员 更 快 、 更 大 的 输入 ， 因 此 车 辆 的 物理 避 撞 极限 应 当 比 驾驶 员 的 避 撞 极限 高 ， 这 里 设 最 大 方向 盘 转 角 5max=720”， 最 大 方向 盘 转 速 


8 =1200°/s 


驾驶 员 触 发 型 紧急 转向 辅助 控制 需要 解决 三 个 主要 的 问题 : 驾驶 员 转 向 避 撞 行为 辨识 、 避 撞 路 径 规 划 和 避 撞 路 径 跟 踩 。 
1. 驾 驶 员 转 向 避 撞 行为 辨识 


驾驶 员 转 向 避 接 行为 辨识 属于 驾驶 员 操 纵 层 (Maneuver) 的 驾驶 行为 估计 范畴 ， 即 估计 驾驶 员 的 操作 意图 ， 目 前 主要 通过 机 器 学 习 方 法 来 实现 ， 比 
如 相关 向 量 机 (Relevance Vector Machine，RVM) 、 支 持 向 量 机 (Support Vector Machine，SVM) 等 。 由 于 具有 民 好 的 鲁 棒 性 和 模型 框架 通用 
性 ， 且 善于 处 理 时 间 序 列 数据 ， 隐 性 马尔 科 夫 模型 (Hidden Markov Model，HMM) 也 得 到 了 越 来 越 多 的 应 用 。 


上 述 方法 需要 经 过 烦琐 的 学 习 训 练 过 程 ， 训 练 库 的 完备 性 和 准确 性 对 算法 的 性 能 影响 很 大 。 因 此 ， 本 书 采 用 Hong 等 人 提出 的 方法 ， 基 于 方向 盘 中 心 特 
性 ， 通 过 对 忽 驶 员 施 加 在 方向 盘 上 的 转向 力矩 、 方 向 盘 转角 、 侧 向 加 速度 、 方 向 盘 转速 以 及 车 速 等 五 个 参数 进行 分 析 ， 得 到 驾驶 员 转 向 意图 系数 


(Driver s Intention to Steer，DIS) ， 然 后 采用 该 系数 对 雪 驶 员 的 紧急 转向 避 撞 行为 进行 判断 。 


介入 
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图 4-25 ”驾驶 员 触 发 型 紧急 转向 辅助 控制 


避 撞 路 径 规 划 是 紧急 转向 避 撞 控制 的 难点 ， 这 些 方法 要 么 及 用 预定 义 轨迹 ， 只 适用 于 非常 特定 的 简单 工 况 ， 且 无 法 考虑 与 备 驶 员 行 为 的 协同 ; 要 么 采 
用 一 些 复杂 的 路 径 规 划 方 法 ， 如 模型 预测 控制 (MPC) 。 这 些 方 法 中 如 果 采 用 复杂 的 车 辆 动力 学 模型 ， 则 能 够 非常 准确 地 规划 路 径 ， 但 计算 负 葵 会 非常 
大 ， 难 以 满足 实时 计算 的 需要 ;如果 玉 用 简单 的 车 辆 动力 学 模型 ， 虽然 解决 了 计算 效率 问题 ， 但 有 可 能 使 得 规划 出 的 路 径 车 辆 无 法 跟随 。 


为 了 处 理 车 辆 动力 学 可 达 性 与 计算 效率 的 矛盾 ， 本 书 提出 一 种 新 的 路 径 规 划 方 法 用 于 紧急 转向 避 撞 控制 。 如 图 4-26 所 示 ， 针 对 典型 危险 场景 ， 首 先 人 在 
线 下 计算 针对 特定 的 几 组 初始 条 件 的 避 撞 路 径 和 能 ， 这 尝 路 径 是 通过 求解 最 优 控制 问题 得 到 的 ， 同 时 考虑 了 和 车辆 的 动力 学 特征 ， 保 证 了 竹 辆 动力 学 可 达 性 。 
计算 出 这 些 路 径 后 ， 将 其 存放 到 最 优 路 径 库 中 。 
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图 4-26 基于 场景 的 路 径 规划 方法 


在 特定 的 危险 场景 下 ， 根 据 当前 目标 信息 、 道 路 环境 信息 以 及 车 辆 信息 ， 提 取出 当前 危险 场景 的 特征 参数 ， 并 根据 这 些 参 数 通过 查 表 的 方法 在 危险 场 
景 数据 库 中 找到 与 当前 场景 最 为 接近 的 场景 ， 该 场景 的 避 撞 路 径 已 经 存放 在 最 优 路 径 库 中 。 由 于 当前 场景 的 参数 不 可 能 与 但 表 得 到 的 最 接近 场景 的 参数 完 
全 一 致 ， 因 此 需要 通过 插值 得 到 对 应 于 当前 场景 的 避 撞 路 径 ， 然 后 根据 该 路 径 开 友 路 径 跟 中 控制 算法 。 


例如 ， 本 书 在 4.2.2 中 对 转向 避 撞 所 需 的 最 短 纵向 距离 进行 分 析 时 ， 选 取 了 前 车 静止 工 况 ， 然 后 采用 高 斯 伪 谱 法 求解 最 优 控制 问题 ， 得 到 满足 车 辆 动力 
学 约束 、 安 全 约束 以 及 执行 器 约束 的 最 优 如 撞 路 径 。 此 处 也 以 该 种 类 型 的 工 况 为 例 ， 取 道路 摩擦 系数 n=0.8， 本 车 与 目标 车 的 重要 率 为 100%， 其 他 条 件 同 
4.2.2 节 ， 求 解 得 到 本 车 车 速 为 (55，60，70，80，85}km/h 五 种 工 况 下 的 最 优 避 挤 路 径 ， 如 图 4-27 所 示 ，。 


对 于 不 同 的 场景 条 件 〈 这 里 简单 起 见 ， 仪 以 车 速 为 例 ) ， 可 通过 在 预先 计算 得 到 的 避 撞 轨迹 艇 之 间 插 值得 到 对 应 于 当前 场景 的 避 撞 轨迹 。 在 进行 插值 
时 ， 将 当前 场景 的 初始 条 件 作 为 输入 ， 最 优化 得 到 的 轨迹 ( 见 图 4-27) 视 作 输出 ， 输 入 和 输出 之 间 视 作 隐 形 高 其 过程。 进行 插值 的 目的 是 确定 该 高 斯 过 程 
的 未 知 参数 ， 以 预测 不 同 场景 初始 条 件 下 的 最 优 轨迹 。 这 里 仅 以 初始 车 速 为 例 ， 实 际 上 这 种 方法 扩展 到 了 更 多 的 参数 ， 比 如 道路 摩擦 系数 、 避 撞 所 需 侧 同 
位 移 等 ， 只 要 在 感 兴趣 的 参数 区 域内 有 足够 的 数据 点 即 可 。 
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d ) 不 同 车 速 下 航 回 角 轨 迹 


时 间 (s ) 
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图 4-27 ”不同 车 速 下 的 轨迹 千 
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本 书 采用 统计 插值 法 (Statistical Interpolation) 中 的 克 里 金 (Kriging) 法 [11] ， 这 种 方法 假设 每 次 观察 得 到 的 实际 观测 值 都 是 一 个 潜在 随机 过 程 
的 实现 ， 且 这 个 随机 过 程 是 高 斯 过 程 。 在 使 用 克 里 金 法 对 一 个 给 定 的 点 的 输出 进行 估计 时 ， 插 值 权 重 不 是 恒定 的 ， 与 该 点 距离 更 近 的 点 将 具有 更 大 的 权 
重 ， 也 就 是 与 估计 点 距离 更 近 的 点 对 估计 值 影响 更 大 。 


克 里 金 法 具有 以 下 特点 : 
(1) 无 偏 ， 即 估计 误 舌 的 期 望 值 为 0。 
(2) 最 优 ， 误 差 的 方差 最 小 。 
(3) 精确 ， 在 已 观测 点 进行 插值 得 到 的 结果 与 观测 结果 一 致 。 
(4) 计算 效率 高 ， 适 合 在 线 计算 。 


在 使 克 里 金 法 进行 插值 时 ， 考 虑 给 定位 置 集合 X={X1，.…，XN}ER"xN， 其 中 xie Rn。 对 未 知 函 数 y:Rn 一 R 进 行 观测 ， 假 设 有 以 下 回归 模型 : 


T ， 
y(%) = >》 Bifi (x) +z=/(x)B+z (4-47) 
k=1 
其 中 ff (x) = (f1 (Xx) ，,..., fr (x) ) 1 为 基 函 数 ， (B1, 1, Br) TeR' 为 回归 系数 ，zE RN 为 观测 误差 。 现在 设 y= (y (xX1) ， 
(XN) ) [= (y1，…，yN) “ER 为 观测 矢量 ,给 定数 据点 (y，x1，.…，XN) ， 式 (4-47) 中 的 回归 模型 可 以 写成 以 下 的 通用 形式 : 


y=F (X) B+z (4-48) 


其 中 z= (z1，...，ZN) TERN 为 观测 误差 矩阵 ，F (X) ERNx 纹 回 归 函 数 和 矩阵 ， 表 达 式 为 : 


Ce ta 和 Ee 


F(X) = (FUxz ,fxs) ) _ A el Ee A 


fl) lM) ww fm) 
(4-49) 


式 (4-48) 中 的 统计 估计 误差 z 可 以 用 稳 态 协 方差 随机 过 程 表示 ， 它 具有 以 下 属性 : 

已 [zj] =0 

cov [z] =E [zzIT] =C=c2R (4-50) 

其 中 ，C，RERNxN， 分 别 为 协 方差 矩阵 和 相关 系数 矩阵 ， 这 两 个 矩阵 通过 下 式 定义 : 

E Lzi2jj =Cij=G2Rij (xi, Xj)， i, j=1, .., N (4-51) 

其 中 Rij (xi，X) 为 稳 态 相关 函数 ， 将 在 后 面 进行 定义 。 

现在 设 一 个 新 的 位 置 xoEco (x1，x2，…，XN) ， 需 要 估计 该 点 的 值 y (x0) ， 其 中 co (:) 表示 凸 包 (Convex Hull) 。 根 据 式 (4-47) ，y (x0) 的 
估计 值 为 : 

y (xy) =f (xo) lptzg C4=52) 


其 中 标量 zo 表示 估计 误 秦 ， 考 虑 样本 误差 之 间 的 相互 依赖 天 系 式 (4-50) ， 这 里 假设 : 


一 


E| zo = 
cov[z]= 了 [2 ] = (4-53) 
cov[Z,z | = or(x,) 


其 中 r (xg) ERN， 表 示 z 和 zo 之 间 的 相关 系数 矢量 。 


现在 假设 式 (4-52) 中 的 最 佳 线性 估计 可 以 写成 观测 值 的 函数 形式 ， 得 到 : 
N 
(Xo0) = Ow =w 4-54 
y(Xo) = > wiyi =wy 【4-54 ) 
t=] 


其 中 w= (w1，...，wWN) TERN 表 示 权 重 系数 的 列 向 量 ， 近 似 残 差 表 示 为 : 


N 
el ) = 人 一 yo ) = py 和 y(xXo) (4-355) 
二 
为 了 确定 最 优 的 权重 系数 列 向 量 w， 我 们 来 取 克 里 金 法 通过 求解 以 下 最 优化 问题 来 获得 最 佳 线 性 无 俩 估计 。 
min var| £ (Xo ) | (4-56) 
MW 
s.t. Ele(xo)|] =0 
将 上 式 写 成 二 次 规划 (Quadratic Programming，QP) 的 形式 ， 得 到 : 
min varl se(x )] = mino [1+mRw -2wr(x,))| (4-57) 
MW MW 
s.t. F(XK) w -f(x6) =0 
根据 上 式 ， 可 以 将 式 (4-54) 中 的 最 佳 线性 无 偏 估计 表示 为 : 
F(x0) = RR {r(xo) ~ F(X)LF(X) R F(X)] [F(X) R r(xo) 一 所 如)] 7 
(4-58) 


然后 ， 将 上 式 写 成 如 下 形式 ,: 


y( xXo) SJ a (4-59) 


B= [F(X) R F(X)| [F(X) Ry| (4-60) 
y =R [y- F(X)B’ (4-61) 


B 是 回归 间 题 yxF (X) B 的 广义 最 小 二 乘 解 ， 也 称 为 艾 肯特 广义 最 小 二 乘 平方 估计 量 (Aitken's GLS Estimator) 。 从 式 (4-59) 中 可 以 看 出 ， 如 果 
假设 误差 之 间 不 相关 ， 则 r (xo) =0, 式 (4-59) 的 解 与 广义 最 小 二 乘法 的 解 等 价 。 另 外 ， 对 于 给 定 的 点 x1，x2，.….，XxN 和 观测 值 y，B 和 Y 唯一 确定 。 


如 前 所 述 ， 克 里 金 插值 是 精确 插值 ， 在 观测 点 的 估计 值 应 精确 等 于 观测 值 ， 比 如 选择 x0=x: 作 为 估计 点 ，r (x;) 是 相关 系数 和 矩阵 R 的 第 列 ， 因 此 R- 
1r (x;) =eij，e 是 单位 矩阵 的 第 列 ， 则 有 : 


y(X,) 


f(x)'B” +r(x,)R  [y - F(X)B”)] 
f(x,) B' +ely - F(X)B’ |] 
f(xi) B +y;- F(x)B’ (4-62) 


Y : 


克 里 金 插 值 的 准确 性 高 度 依赖 式 (4-51) 和 式 (4-53) 中 相关 立 数 的 选择 ， 因 为 相关 消 数 决定 了 观测 值 对 周围 区 域 的 影响 。 这 种 影响 不 是 先 验 可 知 
的 ， 必 须根 据 数 据 进 行 估计 。 为 了 寻找 近似 得 到 相关 销 数 的 万 法 ， 通 常 假设 相 关 函 数 可 以 写作 如 下 形式 : 


R,(0;xi,x,) = [|[p(O0;x;” zc) = Too zc” =- |) (4-63) 


Fe] sl 


9 为 指定 参数 ，xi, xjER",，x (k) 表示 矢量 x 的 第 k 个 元 素 。 上 式 将 多 维 相关 函数 表达 成 n 个 一 维 相关 函数 的 积 。 一 维 相关 函数 同时 依赖 于 参数 6 以 及 所 
加 (Fk) 


a 
考虑 的 两 点 之 间 的 距离 
limp( Qs 1 =0 


(有 
| 为 了 得 到 适当 的 相 天 逆 数 Rij， 对 于 所 有 |>0， 相 天 函数 p 必 须 满足 0<p (0; 1) <1, 且 p (0; 0) =1, 


， 表 示 距 离 远 的 点 相关 性 弱 ， 同 一 个 点 之 间 的 相关 性 最 强 。 


参数 6 决定 了 相关 阔 数 趋 于 0 的 速度 ， 可 以 通过 最 大 似 然 估计 (MLE) 的 方法 求 得 ， 即 : 


0 = arg ming” |R| Nn (4-64) 
9 


其 中 ，|R| 为 R 的 行列 式 ，N 为 给 定位 置 点 数目 。 


本 节 已 经 求 出 了 车 速 为 55，60，70，80，85}kmyh 时 的 避 撞 轨迹 篮 ( 见 图 4-27) ， 此 处 利用 上 述 克 里 金 插值 方法 ， 求 得 任意 车 速 在 
55km/h<uozs85km/h 范 围 内 的 (近似 ) 最 优 轨迹 。 


uw=6, 
根据 式 (4-59) ， 每 个 需要 插值 的 变量 都 需要 一 个 特定 的 插值 模型 ， 在 此 分 别 对 状态 变量 E={，Y， 中 ，X，Y，5f}、 控 制 输入 / 以 及 避 撞 轨迹 
终止 时 刻 tf 进 行 插值 。 采 用 Matlab 的 DACE 工 具 箱 【1<1 进行 求解 ， 选 取 一 次 线性 回归 函数 、 立 方 相关 函数 模型 ， 参 数 6 通 过 最 大 似 然 估计 得 到 。 图 4-28 为 
方向 盘 转 角 的 插值 结果 。 


) 


方 问 盘 和 转角 (” 





图 4-28 ”方向盘 转 角 输 入 播 值 


取 任 意 插值 点 的 速 戎 ， 比 如 uo=65.41km/h， 对 比 插值 得 到 的 轨迹 和 通过 最 优化 离线 计算 得 到 的 轨迹 ， 结 果 如 图 4-29 和 图 4-30 所 示 。 可 见 ， 两 者 之 间 
几乎 完全 重合 ， 因 此 通过 对 离线 计算 到 的 最 优 避 撞 轨迹 进行 插值 ， 得 到 的 轨迹 能 够 满足 避 撞 控制 的 需要 。 
3. 避 撞 路 径 跟踪 

在 检测 到 驾驶 员 有 紧急 转向 避 撞 行为 并 且 根 据 当前 工 况 参数 确定 了 转向 避 撞 路 径 后 ， 我 们 需要 控制 车 辆 沿 着 该 路 径 行 驶 ， 即 路 径 跟 路 。 


目前 有 天 路 径 跟 踩 的 论文 已 经 很 多 ， 最 简单 也 最 通用 的 是 采用 前 馈 + 上 反馈 的 路 径 跟 踪 方 法 ( 见 图 4-31) ， 首 先 根据 参考 轨迹 计算 出 相应 的 转向 角 作 为 
前 饥 输 入 ， 但 由 于 竹 辆 模型 与 实际 车 辆 之 间 的 翁 疼 、 外 界 干扰 等 因素 的 影响 ， 由 前 馈 输 入 得 到 的 轨迹 输出 与 理想 的 参考 轨迹 乙 间 必然 仔 企 着 差 异 ， 因 此 再 
加 上 一 个 反馈 控制 器 ， 根 据 差 异 的 大 小 确定 反馈 输入 的 值 。 最 终 前 馈 输入 与 反馈 输入 硬 加 在 一 起 ， 控 制 车 辆 尽 可 能 好 地 跟踪 参考 路 径 。 
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图 4-29 ”插值 和 最 优化 控制 得 到 的 避 撞 轨迹 对 比 


2 


图 中 的 两 条 线 重 合 。 


注 。 


插值 
最 优化 


转 问 角 (°) 





0 0.5 | 1.5 2 2 3 3 
时 间 《s ) 


图 4-30 ”插值 和 最 优化 控制 得 到 的 方向 盘 转 角 输 入 对 比 


车 辆 模型 


避 撞 路 径 规划 | yw 而 


WW, ef, W, ‘el 





图 4-31 ”前 馈 + 反 馈 的 路 径 跟 踪 方 
注 : 图 中 的 两 条 线 重 合 。 
本 书 也 党 试用 这 种 方法 来 实现 避 撞 路 径 跟 踪 ， 如 图 4-31 所 示 ， 前 馈 转 向 角 输 入 FF 直接 通过 路 径 规划 得 到 。 由 于 路 径 跟 踩 控 制 的 主要 目的 是 让 车 辆 沿 
参考 路 径 行 驶 ， 因 此 最 理想 的 情况 是 直接 对 和 车 辆 的 位 置 进行 控制 。 本 书 主 要 控制 车 辆 侧 向 位 置 Y 和 航向 角 由 两 个 变量 ， 侧 向 位 置 与 航向 角 的 参考 轨 了 迹 Yref 及 
ref 是 车 辆 纵向 位 置 X 的 冰 数 ， 可 以 根据 路 径 规 划 结 果 和 直接 获得 。 针 对 侧 同 位 置 Y， 本 书 设计 了 一 个 PID 控 制 器 ， 用 以 减 小 侧 向 位 置 误 差 ， 即 : 


Or, = Ky,yey + Kjyleydr 二 大 yey (4-65) 


Y } 
其 中 ， Or 是 根据 侧 向 位 置 Y 偏 差 的 反馈 转向 角 输 入 ，ey 是 侧 向 位 置 偏差 ， Kpy、KIy 以 及 KDy 分 别 为 PID 控 制 器 的 比例 增益 、 积 分 增益 以 及 微分 增益 参 


é é 
数 ， 如 图 4-32 所 示 。 ” 是 侧 向 位 置 偏 差 的 导数 ，ey 和 “的 表达 式 为 : 


Gy (4-66) 
二 -7 = WL sini( /大风 + Bwcos( nr) ] - | xsin(wW) + ycos( 四 ) 
(4-67 ) 


其 中 Bref 可 根据 避 撞 路 径 规 划 结 果 得 到 。Kpy、Kly 以 及 KDy 分 别 为 PID 控 制 器 的 比例 增益 、 积 分 增益 以 及 微分 增 蔓 参 数 。 





图 4-32 ”位 置 偏差 示意 图 


另外 ， 针 对 航向 角 由 的 偏差 ， 本 书 设计 了 一 个 PD 控制 器 (为 了 防止 对 横 摆 角速度 进行 二 次 积分 引入 较 大 误差 ， 这 里 不 引入 积分 控制 ) ， 基 于 航向 角 偏 
差 的 反馈 转向 角 输 入 为 : 


其 中 ，ew 为 航向 角 偏差 。 “为 航向 角 偏差 的 导数 ， 表 达 式 为 : 
Cy ,or 和 Wh 
ey = Wr- (4-69) 


炒 ,也 可 根据 避 撞 路 径 规划 结果 直接 得 到 ，Kpu 和 Kbpu 为 PD 控 制 器 的 积分 增益 和 微分 增益 。 


i 
Oks 二 OFp + OFp ， 车 辆 总 的 转向 角 输 入 为 : 


总 的 反馈 输入 

O=OFF+TOFP (4-70) 

由 于 车 辆 动力 学 的 影响 ， 转 向 输入 的 响应 会 有 一 定 的 延迟 ， 这 种 延迟 在 紧急 工 况 下 可 能 会 导致 严重 的 后 果 。 为 了 弥补 延迟 带 来 的 影响 ， 本 书 在 反馈 控 
制 中 引入 预 瞄 信息 。 如 图 4-33 所 示 ， 设 预 瞄 时 间 为 tp， 车 辆 当前 车 速 为 u， 预 瞄 距 离 dp=utp， 则 预 瞄 点 的 侧 向 位 置 偏差 为 : 


CY, Pp™ (Yref-Y) X=Xp™=1ref, Br [Yt+dpsin (VW) 」 (4-71) 


其 中 ，Xp 为 预 瞄 点 在 大 地 坐标 系 下 的 纵向 位 置 ，Xp=X+dpcos ( 业 ) 。Yref，P 为 Xp 处 的 参考 侧 向 位 置 ， 可 直接 根据 避 撞 路 径 规 划 结 果 查 表 得 到 。 


预 瞄 点 





图 4-33” 预 瞄 示 意图 


同 理 ， 预 瞄 点 的 侧 向 速度 偏差 、 航 向 角 偏 差 以 及 横 摆 角速度 偏差 为 : 
(yw — Y)x-x, = Typp 一 [了 + dpysin(y) | 


vol sin(W,p ) + Bpeos( Wp) ] 一 | Lxsin(w) + ycos(w) | k dpysin(y) | 
(4-72) 


Cy,P 


Cyp = Wp -vy 


eyp = Wp —Y (4-73) 


ref，P、Bref，p 直 接 根 据 避 撞 路 径 规划 结果 查 表 得 到 。 


4 .仿真 验 证 


虽然 基于 前 馈 和 反馈 的 控制 结构 非常 简单 ， 经 过 PID 参 数 整定 后 也 能 获得 较为 满意 的 控制 效果 。 本 书 通过 PreScan 和 Carsim 联 合 仿真 进行 验证 ， 图 4- 
34 为 本 车 车 速 为 70km/h 时 的 避 撞 轨迹 跟 中 效果 。 可 以 看 到 ， 本 车 侧 向 位 置 很 好 地 跟 中 了 参考 轨迹 。 
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图 4-34 ”轨迹 跟踪 效果 
注 : 图 中 两 条 线 重合 。 
相 较 于 侧 向 位 置 ， 航 向 角 跟 踪 的 效果 相对 较 差 ( 见 图 4-35) ， 航 向 角 回 到 0 的 时 间 比 参考 轨迹 长 ， 避 撞 所 需 的 时 间 比 参考 路 径 耗 时 要 长 。 这 种 滞后 在 
党 情况 下 并 无 多 大 影响 ， 但 如 果 是 占用 旁 车 道 完 成 避 撞 同时 该 车 道 有 对 向 来 车 ， 本 车 完成 避 撞 后 需要 立刻 返回 原 车 道 ， 那 么 这 种 沸 后 可 能 会 市 来 严重 的 
果 。 
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0 ] 7 3 4 
时 间 (8) 


在 仿真 中 ， 本 车 实际 方向 盘 转角 输入 与 参考 方向 盘 转角 输入 的 对 比如 图 4-36 所 示 。 可 见 ， 由 于 车 辆 动力 学 建 模 的 简化 ， 实 际 的 车 辆 方向 盘 转角 输入 与 
参考 输入 之 间 的 差异 较 大 ， 进 一 步 说 明 如 果 在 路 径 规 划 中 ， 为 了 实时 性 的 需要 采用 过 于 简化 的 车 辆 动力 学 模型 ， 得 到 的 轨迹 很 可 能 车 辆 不 可 达 。 
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图 4-36 方向盘 转角 输入 


4.3.2 ”矫正 型 汉 急 转 同 辅助 控制 


当 障 碍 物 是 行人 、 骑 车 人 等 时 ,通常 只 占用 道路 宽度 的 很 小 一 部 分 ， 通 过 矫正 型 紧急 转向 辅助 控制 局 动 上 自动 罕 急 转向 进行 避 撞 时 不 需要 越 出 本 车 道 ， 
因此 误 作 用 导致 严重 后 果 (比如 与 旁 车 道 对 向 驶 来 的 车 辆 友 生 磁 撞 ) 的 可 能 性 较 小 。 由 于 骑 车 人 、 行 人 等 VRU 在 我 国 的 道路 环境 中 构成 的 危险 非常 典型 ， 
因此 本 书 将 矫正 型 紧急 转向 辅助 控制 也 引入 到 目 动 紧急 控制 策略 中 ， 整 个 控制 策略 如 图 4-37 所 示 。 
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图 4-37 矫正 型 紧急 转向 辅助 控制 策略 


矫正 型 紧急 转 同 辅助 控制 主要 需要 解决 三 个 方面 的 问题 : 危险 估计 、 路 径 规 划 和 路 径 跟 路 及 仿真 。 


1. 危 险 估计 


当前 已 有 的 一 些 上 自动 转向 避 撞 控制 研究 ， 基 本 都 是 在 完全 制 动 无 法 避 撞 但 转向 还 可 以 避 撞 的 时 候 介 入 。 但 根据 4.2.2 节 中 的 分 析 ， 在 某 些 工 况 下 (比如 
高 相对 速度 、 小 重 芍 率 、 低 附着 系数 等 ) ， 在 制 动 无 法 避 撞 时 ， 通 过 转向 避 撞 也 在 驾驶 员 的 能 力 范围 内 。 因 此 ， 本 书 中 采取 更 为 保守 的 控制 策略 ， 即 系统 
目 动 转向 仪 在 靠 零 驶 员 之 力 无 法 避 撞 但 还 在 车 辆 的 避 撞 极限 范围 内 时 介入 。 


本 书 根 据 转 向 避 撞 所 需 的 最 大 转向 角速度 作为 危险 估计 判断 的 措 标 ， 根 据 对 驾驶 员 紧 急 转 向 行为 分 析 结 果 ， 设 定 和 驾驶 员 的 最 大 方向 盘 转 速 为 500°/s。 
根据 路 径 规 划 结果 ， 如 果 避 撞 路 径 需 要 的 最 大 万 同 盘 转 速 大 于 500*/s， 则 认为 驾驶 员 无 法 回避 碰撞 ， 矫 正 型 紧急 转向 辅助 开始 介入 。 同 时 ， 考 虑 到 执行 器 
的 限制 ， 最 大 方向 盘 转 速 不 能 超过 1200°/s。 


2. 路 径 规 划 


不 失 一 般 性 ， 考 虑 如 图 4-38 所 示 的 行人 横 穿 公路 的 工 况 ， 将 车 辆 视 作 和 矩 形 ， 长 为 5.2m， 宽 2.0m， 和 车 辆 质心 到 车 辆 最 前 端的 距离 为 2.5m， 到 车 辆 最 后 
端 距 离 为 2.7m。 行 人 视 作 一 个 半径 为 Rp=0.4m 的 圆 ， 中 心 坐 标 为 (Xo，Yo) ， 车 道 宽 3.5m。 





图 4-38 ”行人 避 撞 工 况 示意 图 


同 4.3.1 节 ， 本 节 采 用 最 优 控制 方法 来 计算 避 撞 路 径 ， 但 安全 约束 有 所 变化 ， 由 于 车 辆 不 能 越 出 本 车 道 ， 因 此 车 身 左 侧 角 点 最 大 值 Ymax=1.75m， 右 例 


角 点 最 小 值 Ymin=-1.75m。 
同样 将 避 撞 过 程 分 为 两 个 阶段 ， 第 一 个 阶段 起 始 时 刻 to1=0， 终 止 时 刻 tf1=TTC， 第 二 个 阶段 起 始 时 刻 toz=TTC， 终 止 时 刻 tf2? 不 加 限制 。 第 一 个 阶段 的 
目标 国 数 为 : 


/ 


[oaB(D)d + wsd(t) dt + wsd(t) dt] (4-74) 


1 = wnD (ty) + | 


Py 01 
wD 为 终 值 目标 销 数 加 权 系 数 ，D (tf1) 为 终止 时 刻 行人 中 心 坐标 到 本 车 右 侧 边 界 的 距离 ，wp 为 质心 侧 偏 角 目 标 立 数 加 权 系 数 ， 该 值 越 大 表示 整个 转 
OB 
向 避 撞 过 程 越 平缓 ，w5f 及 “7 分 别 为 转向 角 和 转向 角速度 的 目标 函数 加 权 系 数 。 


第 一 个 阶段 的 边界 条 件 为 : 


lol = 


B lol )=0 


y(tn)=0 
W(t)=0 
(i 芝 必 
人 全 一 下 
6(tm)=0 
(to) = free 
tn = TTC (4-75) 


Bl 正二 Jree 
y( bn ) = free 
y(t 全 free 
X( bn ) = free 
Y( br ) = free 
0/( iy) = free 
(tn) = free 
在 tf1 时 刻 ， 除 满足 安全 约束 、 执 行 器 约束 外 ， 行 人 中 心 到 本 车 右 侧 边界 的 距离 D (tf1) 要 满足 以 下 事件 约束 条 件 : 


od 


/1 + i 


，DSM 为 安全 距离 。 


宇 Dy +R, (4-76) 


k=tan[ y(t )) 


其 中 和 


第 二 个 阶段 的 目标 遂 数 为 : 


| = wi, + | | wsB( t) di 十 ws t) dt 十 w;6/( t) dt | (4-77 ) 


102 


6/ 
其 中 wf 为 终 值 目标 为 数 加 权 系 数 ， 值 越 大 表示 要 求 tf>? 越 小 。 


第 二 个 阶段 的 切 值 边 界 条 件 与 第 一 个 阶段 的 终 值 边界 条 件 相同 ， 转 向 避 撞 完成 后 要 求 手 辆 回 到 本 车 和 车道 中心 ， 因 此 第 二 个 阶段 的 终 值 边界 条 件 为 : 


jp = free 
Blin) = 
y(tp) = 
几 tP) = 
X(t,) = 
Vln) 
0/( tp ) = 


6/( bp ) = 0 


| | 
sr 


(4-78) 


I 
= 
CC 


采用 与 4.2.2 节 中 相同 的 车 辆 参数 ， 设 车 速 为 80km/h， 行 人 最 终 Y 轴 向 位 置 坐标 Yo=-0.95m，TTC=0.73s， 此 时 完全 制 动 无 法 避免 磁 撞 ， 采 用 4.3.1 节 
中 类 似 的 万 法 求解 最 优 控制 问题 得 到 避 撞 路 径 ， 如 图 4-39 所 示 。 

从 图 4-39f 中 可 以 看 出 ， 最 大 方向 盘 转 速 为 586.48*/s， 大 于 500°/s 但 小 于 1200*/s， 说 明 当 前 危险 还 可 以 通过 转向 进行 回避 ， 但 已 经 超过 了 大 部 分 驾驶 
员 的 能 力 范 围 ， 此 时 需要 矫正 型 罕 急 转向 辅助 控制 介入 对 驾驶 员 提 供 辅 助 。 

与 4.3.1 节 相同 ， 在 规划 出 不 同 起 始 条 件 的 避 撞 路 径 后 ， 及 用 多 里 金 法 进行 插值 ， 可 以 得 到 任意 起 始 条 件 下 的 避 撞 轨迹， 只 要 该 起 始点 在 路 径 规 划 点 构 
成 的 凹 包 内 。 


3. 路 径 跟 踪 及 仿真 


本 节 采 用 4.3.1 节 中 所 述 的 前 馈 +PID 反 馈 控 制 的 结构 进行 路 径 跟 中 控制， 及 用 PreScan 和 CarSim 的 联合 仿真 。 图 4-40 是 场景 示意 图 ， 本 和 车 以 80km/h 的 
速度 向 前 行驶 ， 车 辆 右前 方 一 行人 从 路 边 停 车 车 辆 后 走出 ， 车 辆 探测 到 行人 时 TTC 值 为 0.73s。 驾 驶 员 惊 尺 之 下 之 无 反应 ， 目 动 罕 急 控制 系统 启动 矫正 型 罕 
急 转 向 辅助 控制 进行 避 撞 ， 图 4-41 至 图 4-43 是 仿真 结果 ，。 
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图 4-39 ”转向 避 樟 轨 还 


响 


， 实 际 


向 角 跟 中 的 效果 相对 较 差 ( 见 图 4-42) 


径 。 相 较 于 侧 向 位 置 ， 航 


了 参考 路 


吃 


味 


策略 很 好 地 跟 


味 


路 径 跟 
但 这 种 沛 后 对 避 撞 的 效果 影响 不 大 。 


可 以 看 到 ， 


图 4-41 为 避 撞 轨 人 迹 跟 踪 效 果 。 
必 与 参考 轨迹 之 间 存 在 一 定 的 延 时 ， 








图 4-40 危险 场景 
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图 4-41 ”轨迹 跟踪 效果 图 


注 : 两 条 轨迹 重合 
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图 4-42 ”航向 角 跟 踪 效果 


在 仿真 中 ， 本 车 实际 转向 角 输 入 与 参考 方向 盘 转角 输入 的 对 比如 图 4-43 所 示 。 可 见 ， 昌 然 路 径 规 划 时 使 用 了 珊 非 线性 轮胎 模型 的 二 自由 度 车 辆 模型 ， 
但 在 建 模 时 的 简化 还 是 使 得 竺 辆 模型 与 实际 车 辆 特性 之 间 人 存 企 较 大 的 差异 ， 这 种 差异 在 避 撞 这 种 车 辆 非 绪 性 比较 明显 的 情况 下 导致 了 实际 转向 角 与 参考 转 
向 角 之 间 存 在 较 大 的 差异 ， 但 通过 反馈 控制 对 转向 角 进 行 调整 可 以 取得 满意 的 路 径 跟踪 效果 。 
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图 4-43 方向盘 转角 输入 


4.3.3”AEB 算 法 的 优化 


根据 本 章 的 分 析 结果 ， 我 们 可 以 对 目 动 紧急 制 动 (AEB) 控制 算法 进行 优化 。 为 了 防止 与 等 驶 员 有 意识 的 转向 避 撞 行为 相 冲突 ， 在 千 速 较 局 时 设置 临 
界 TTC-1 值 通常 设 为 定 值 。 根 据 4.2 忆 中 的 分 析 结 果 ( 见 图 4-44) 可 知 ， 这 种 设置 具有 相当 的 合理 性 ， 因 为 在 高 速 时 驾驶 员 转 向 避 撞 的 临界 TTC 值 基本 恒 
定 。 但 是 ， 传 统 的 临界 TTC-1 值 的 计算 方式 相对 简单 ， 根 据 4.2 节 中 的 分 析 结 果 可 以 进行 更 准确 的 定义 ,得 到 任意 工 况 下 的 制 动 转向 临界 距离 和 临界 TTC 
值 ， 进 一 步 优化 算法 性 能 ， 使 得 系统 介入 的 可 靠 性 更 高 。 

如 图 4-44 所 示 ， 设 临界 速度 为 vG， 即 车 速 低 于 VG 时 ， 制 动 避 撞 所 需 的 纵向 距离 小 于 转向 避 撞 ， 制 动 避 撞 的 效用 更 高 ， 当 速度 高 于 VG 时 则 相反 。 理 想 情 
况 下 ，AEB 系 统 应 该 在 区 域 和 区 域 荆 的 切换 面 以 及 区 域 I 内 介入 。 在 区 域 I 和 区 域 一 的 切换 面 了 时 ， 由 于 已 经 到 了 驾驶 员 的 避 撞 极限 ， 和 驾驶 员 无 法 避免 而 
撞 ， 但 依靠 执行 器 更 快 更 强 的 介入 ， 能 够 帮助 避免 磁 撞 ， 且 不 会 干扰 驾驶 员 的 正常 驾驶 。 在 区 域 工 介 入 时 不 能 避 撞 ， 只 能 减轻 碰撞 的 程度 ， 这 与 AEB 原 理 
一 致 。 


一 转向 避 撞 极限 (4 = 0.8, 100 驳 覆盖 ) 
一 一 制 动 洲 揪 极 限 (= 0.8 ) 
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图 4-44 ”临界 避 撞 TITC 值 及 区 域 划 分 


在 引入 转向 避 撞 控制 后 ， 由 于 环境 传感器 已 经 能 够 对 车 辆 周围 的 环境 进行 更 为 全 面 和 准确 的 探测 ， 是 否 具有 转向 避 撞 的 空间 可 以 很 容易 确定 ， 因 此 ， 
在 发 现 当前 环境 下 由 于 旁 车 道 有 车 等 情况 导致 不 具备 转向 避 撞 条 件 时 ， 可 提前 触 友 AEB 系 统 的 介入 ， 这 样 可 以 在 更 高 的 速度 避 撞 或 更 大 程度 地 减轻 碰撞 的 
程度 ， 最 大 化 制 动 避 撞 的 潜力 。 如 图 4-45 所 示 ， 设 右 侧 车 道 后方 车 辆 为 本 车 ， 左 图 中 由 于 左 侧 车 道 有 对 向 来 车 ， 本 车 不 具备 转向 避 撞 的 可 能 性 ， 因 此 可 提 
前 AEB 的 触 友 时 刻 ， 比 如 在 区 域 瑟 和 区 域 IV 的 切换 面 或 者 区 域 亚 内 残 开 始 介入 。 在 4-45 右 图 中 ， 由 于 旁 车 道 没 有 车 辆 ， 右 车 道 后 方 车 辆 可 以 通过 转向 吉 
撞 ， 为 了 避免 与 驾驶 员 的 有 意识 转向 避 撞 行为 相 冲 突 ，AEB 系 统 需要 在 区 域 瑟 和 区 域 工 的 切换 面 介 入 ， 只 能 起 到 碰撞 减轻 的 作用 ， 但 通过 引入 本 书 中 所 开 
发 的 紧急 转向 辅助 控制 策略 ， 可 以 在 很 大 程度 上 应 对 此 类 危险 。 





图 4-45 无 (有 ) 转向 避 撞 空间 


4.3.4 制 动 和 转 同 避 撞 控制 集成 


结合 AEB 和 本 章 中 开发 的 紧急 转向 控制 策略 ， 构 成 了 如 图 4-46 所 示 的 自动 紧急 控制 (AEC) 策略 。 


简单 起 见 ， 不 考虑 4.4 节 中 所 述 的 转向 可 行 性 问题 。 对 于 任何 一 个 本 书 中 避 撞 算法 涵盖 的 危险 场景 类 型 ， 如 果 判 断 人 碰撞 无 法 避免 ， 则 局 动 碰 撞 减 轻 控 


制 ， 通 过 制 动 力 调制 和 转向 角 调 制 减 小 Av 并 同时 调整 相对 磁 撞 位 置 和 角度 。 


Mis 


如 果 可 以 避 撞 ， 当 王 速 低 于 vG 时 ， 制 动 避 撞 具有 更 大 的 避 撞 潜力 ， 因 此 当 友 生 危 险 时 ， 首 先 向 驾驶 员 妈 出 人 矶 撞 预 警 ， 提 醒 轨 驶 员 仔 在 的 危险 。 如 果 轰 
驶 员 根 据 碰撞 预警 来 取 了 紧急 制 动 操作 ， 可 以 通过 雪 驶 员 目 己 的 能 力 避 免 筑 撞 。 如 果 笃 驶 员 没有 反应 或 者 有 制 动 行为 但 制 动 力 不 足 以 避免 碰撞 ， 则 在 区 城 
I 和 区 域 工 的 切换 面 触 皮 AEB 索 急 制 动 控制 案 略 避免 碰撞 。 如 果 雪 驶 员 有 非 预期 行为 ， 比 如 转向 ， 由 于 此 时 转 同 无 法 避免 础 撞 ， 系 统 内 驾驶 员 施 加 一 定 的 
反 力 矩 抑制 驾驶 员 的 转向 行为 ， 力 和 起 大 小 在 驾驶 员 能 够 克服 的 范围 内 ， 同 时 向 驾驶 员 友 出 预警 ， 尽 量 改 变 备 驶 员 的 行为 让 其 更 为 合理 。 当 危险 已 经 超过 和 驾 
驶 员 的 避 撞 能 力 范围 时 ， 则 在 区 域 I 和 区 域 工 的 切换 面 触 发 紧急 制 动 控制 进行 避 撞 。 


如 果 和 车 速 遍 于 vG， 此 时 转向 避 撞 具有 更 大 的 潜力 ， 当 进入 区 域 亚 时 ， 向 驾驶 员 友 出 诱导 性 预警 ， 比 如 在 方向 盘 上 施加 方向 性 振动 以 诱导 雪 驶 员 转 癌 ， 
如 果 驾 驶 员 开始 转 疝 避 撞 操作 ， 则 局 动 驾驶 员 触 友 型 紧急 转向 辅助 控制 帮助 区 驶 员 避 免 碰 撞 。 


如 果 驾 驶 员 制 动 ， 由 于 制 动 无 法 避免 碰 撞 ， 因 此 系统 依然 癌 节 驶 员 友 出 诱导 预警 。 如 果 芝 驶 员 转 而 转向 ， 则 系统 通过 雪 驶 员 触 上 友 型 紧急 转 和 控 制 辅助 
轰 驶 员 ; 如 果 雪 驶 员 依然 制 动 ， 则 在 检测 到 当前 环境 不 再 在 驾驶 员 的 能 力 苍 围 内 时 ， 即 到 达 区 域 I 和 区 域 亚 切换 面 时 ， 判 断 避 撞 是 人 否 可 以 在 本 车 道 完 成 。 
如 果 避 撞 可 以 在 车 道 完 成 ， 则 触 友 矫正 型 紧急 转 回 辅助 目 动 帮助 泽 驶 员 避 免 础 撞 ; 如 果 避 撞 不 能 在 本 车 道内 完成 ， 则 通过 调制 制 动 力 和 转向 角 进 行 础 撞 减 
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图 4-46 ” 制 动 和 转向 避 挤 控制 的 集成 





如 果 和 驾驶 员 无 反应 ， 系 统 依然 通过 诱导 预警 提醒 驾驶 员 转 向 ， 然 后 根据 零 驶 员 的 不 同行 为 反应 来 确定 通过 各 驶 员 触 友 型 紧急 转向 辅助 控制 或 烤 正 型 泽 
急 转 向 辅助 控制 进行 避 撞 。 如 果 驾 驶 员 的 行为 反应 不 能 满足 这 两 种 介入 策略 的 触发 条 件 ， 则 进行 碰撞 减轻 控制 。 


通过 图 4-46 中 所 示 的 AEC 妥 略 ， 系 统 能 够 覆 兰 绝 大 部 分 危险 场景 。 但 出 于 可 控 性 的 考虑 ， 本 书 中 只 有 人 在 避 撞 操 作 可 以 在 目 车 道 完 成 时 才 上 自动 介入 转向 
控制 ， 在 其 他 工 况 下 不 涉及 上 自动 转向 ， 因 此 避 撞 效能 还 存在 一 定 的 不 足 。 随 着 未 来 传感器 技术 的 友 展 、 人 机 交互 界面 设计 的 进步 以 及 相关 法 律 的 跟 进 ,车 
辆 可 通过 上 自动 转向 控制 来 履 苹 更 多 的 危险 场景 。 


4.4” 制 动 转 同 协调 避 撞 控制 


虽然 车 辆 利用 制 动 和 转向 的 协调 控制 可 以 使 纵向 避 撞 距离 最 小 化 ， 但 到 目前 为 止 本 书 只 开 友 了 单独 的 制 动 和 转向 避 撞 控制 策略 ， 并 没有 考虑 二 者 的 协 
调控 制 ， 除 了 控制 器 设计 的 难度 之 外 ， 其 主要 原因 是 转向 避 撞 过 程 可 能 会 占用 其 他 和 车道， 车 辆 减速 市 来 的 机 动 性 降低 ， 可 能 会 影响 车 辆 快速 回 到 原 车 道 ， 
因此 制 动 并 不 是 一 种 理想 的 选择 。 但 是 ， 从 驾驶 员 避 撞 行 为 分 析 可 知 ， 驾 驶 员 在 转向 避 撞 时 通常 都 伴随 着 制 动 操作 ， 这 可 能 会 对 转向 避 撞 控制 的 效果 造成 


不 民 的 影响 。 因 此 ， 本 书 中 来 用 忽略 各 驶 员 制 动 的 转向 避 撞 策略 虽然 可 以 保证 避 撞 的 效果 ， 但 也 存在 影响 用 尸 接受 度 的 风险 ， 因 为 车 辆 对 驾驶 员 的 制 动 行 
为 没有 响应 。 另 外 ， 在 本 书 的 转向 避 撞 策略 中 ， 车 辆 沿 特 定 的 轨迹 行驶 ， 虽 然 路 径 规 划 时 考虑 了 驾驶 员 的 转向 输入 特性 ， 但 不 可 能 与 驾驶 员 的 预期 轨迹 完 
全 相符 。 


因此 ， 本 书 在 此 探讨 将 制 动 和 转向 的 协调 避 撞 控制 引入 到 上 自动 罕 急 控制 (AEC) 中 ， 由 于 驾驶 员 转 向 同时 制 动 的 避 撞 行为 很 难 建 模 ， 目 前 学 术 界 仍然 
没有 突破 性 的 成 果 ， 因 此 在 此 只 做 理论 推导 ， 当 各 驶 员 模 型 成 熟 后 可 考虑 引入 这 种 控制 策略 。 


本 节 提 出 的 制 动 转向 协调 避 撞 控制 的 介入 原理 是 ， 根 据 各 驶 员 的 输入 并 结合 驾驶 员 模 型 得 到 车辆 的 预期 轨迹 ， 同 时 根据 多 传感器 信息 融合 ， 构 建 道 路 
环境 模型 得 到 车 辆 可 行 域 (Drivable Space) 、 过 渡 域 和 危险 域 。 可 行 域 是 指 车 辆 能 够 稳定 到 达 和 且 不 会 友 生 页 撞 (或 越 出 车 道 ) 事故 的 区 域 ， 过 渡 域 指 虽 
然 车 辆 不 会 发 生 事故 ， 但 安全 容量 较 小 ， 稍 有 偏差 就 会 友 生 事故 的 区 域 ; 而 危险 域 是 指 车 辆 友 生 事故 可 能 性 非常 高 的 区 域 。 如 图 4-47 所 示 ， 如 果 和 车 辆 预期 
轨迹 进入 了 危险 域 ， 则 说 明 驾 驶 员 的 操作 为 不 当 驾 驶 行为 ， 需 要 对 驾驶 员 的 行为 进行 纠正 以 避免 事故 的 发 生 或 减轻 事故 的 伤害 。 如 果 车 辆 预期 轨迹 在 过 渡 
域内 ， 和 驾驶 员 的 操作 为 危险 驾驶 行为 ， 需 要 对 驾驶 员 进 行 预警 。 如 果 和 车 辆 预期 轨迹 在 车 辆 可 行 域内 ， 则 驾驶 员 的 操作 是 正确 操作 ， 系 统 无 须 介 入 。 
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图 4-47 ”基于 制 动 转向 协调 控制 的 AEC 介 入 原理 


在 这 种 控制 荣 略 中 ， 驾 驶 员 始 终 在 环 ， 系 统 的 控制 输入 根据 雪 驶 员 的 输入 进行 实时 调整 ， 并 最 终 与 驾驶 员 的 输入 堵 加 在 一 起 作为 后 辆 的 总 输入 。 整 个 
控制 系统 框 以 如 图 4-48 所 示 。 


控制 尼 





图 4-48 制 动 转 向 协调 避 樟 控制 框架 


4.4.1 车 辆 模型 


本 书 采 用 的 车 辆 模型 如 图 4-49 所 示 ， 考 虑 车 身 的 纵向 、 横 向 和 横 摆 运 动 三 个 自由 度 以 及 四 个 车 轮 的 旋转 自由 度 。 另 外 ， 为 了 方便 引入 环境 约束 ， 这 里 
还 考虑 侧 向 位 置 偏差 、 航 向 角 偏 差 以 及 车 道中 心 线 三 个 自由 度 。 车 辆 的 运动 可 以 用 以 下 的 微分 方程 表示 : 


4 
mx = my + Or, 


i=] 


4 
-miy + Or, 


i=] 


S 
a 
[ 


和 WwW, 
ly = A ne = | + (- PF a a + FF,) (4-79) 


CN 。 
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vw Vy 加 Wa 


xsin(e,) + ycos(e,) 


CN 。 
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$ = xXcos(e,) — ysin(e,) 


Wa 





图 4-49 ”车辆 模型 示意 图 
其 中 ，m 为 车 辆 质量 ，| 为 车 辆 绕 z 轴 的 转动 惯量 ，|f 表 示 车 辆 质心 到 前 轴 的 距离 ，| 表 示 质 心 到 车 辆 后 轴 的 距离 ，wt 表 示 轮 距 ， 此 处 假设 前 后 轮 距 相 
等 ， 和 4 分 别 表示 车 辆 的 纵向 和 横向 速度 炒 去 示 车 辆 的 横扫 角速度 iE{1，2，3， 活 ,分 别 表示 和 车辆 的 左前 轮 、 右 前 轮 、 左 后 轮 、 石 后 轮 。ey 为 


车 辆 质心 到 车 道中 心 线 的 垂直 距离 ，eu 为 车 辆 航向 角 由 与 车 道中 心 线 切线 和 大 地 坐标 系 XOY 的 X 轴 之 间 的 夹 角 中 road 的 差 值 ，s 为 车 辆 沿 车 道中 心 线 的 纵向 
位 置 。Fx0Fy 是 车 轮 的 纵向 力 fxi 和 侧 向 力 fyj 在 车 辆 坐标 系 的 x 轴 与 y 轴 上 的 分 力 ， 两 者 之 间 的 转换 关系 为 


FExi=fxicos〈5i1) -fyiSsin (651) 


Fort=Lxroin (51) +fyiCos (51) (4-80) 
其 中 6 表示 和 车轮 | 的 转向 角 ， 在 本 书 中 假设 车 辆 只 有 前 轮转 同 且 左右 前 轮转 向 角 相等 ， 即 61=62=6f，63=64=0。 


根据 Pacejka 轮 胎 模 型 ， 轮 胎 的 纵向 力 fx 和 0 侧 向 力 fy; 可 以 写成 如 下 形式 


fyi=fc (Qi, Oi, hi, Fzi) (4-81) 


其 中 ie{1，2，3， 活 ，oi 表 示 轮 胎 i 的 交 移 率 ，ai 表 示 轮 胎 的 侧 偏 角 ，b 是 道路 轮胎 处 的 道路 摩擦 系数 ，Fjz 表 示 轮 胎 i 的 法 向 力 。Fz 表 达 式 为 : 











六 / 本 h, . L, h, ] 
0 

站 hh, yr le 2 (4-82) 
MM VT 

| Ll 2 h, Y y 人 一 和 

a 人 三 2 六 十 六) 六 二 0 

p 和 1 pe Ly hi 一 4 

“gt + 4,) 次 2 + lh,) 及 络 六 + 


其 中 hg 为 车 辆 质心 高 度 。 设 Vc 为 车 轮 i 的 在 车 轮 坐 标 系 下 的 侧 向 速度 ，vi; 为 车 轮 i 在 轮胎 坐标 系 下 的 纵向 速度 。 车 轮 的 速度 可 通过 车 轮 在 车 身 坐 标 系 下 的 
x 向 速度 vx 和 y 向 速度 vy 得 到 : 


Vci=vyicos (5i) ~-vxisin (5i) 


V1li=~VyiSin (5i) +VxiCos (5i) (4-83) 


vx 二 Dvyi 可 根据 车 辆 运动 速度 与 车 身 的 几何 关系 得 到 |: 


‘ » WwW, ， 

Li 二 了 ly 》 Wa a bp 》 ] 
WwW, 

Di = +ly, v=%+ 7 1= 2 (4-84) 
。 WwW, ， 

Ui 一 党 - ly, VU, = 区 洗 》 es 3 
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0 = 了 = i=4 


则 轮胎 侧 偏 角 为 : 


L 


0 . 
如 arctan (二 | 二 


(4-85 ) 


L 


/下 . 
Q, = arctan [二 ， L134 


EL 


轮胎 的 滑 移 率 为 : 


We x 100% 制 动 
Vi 
ui = (4-86 ) 
-ec ix100% 加速 
mm (0. 


其 中 ，rw 为 后 轮 的 半径 ，wi 为 车 轮 i 的 旋转 角速度 。 轮 胎 消 移 率 ciE [-1，1] ， 轮 胎 的 旋转 角速度 可 通过 下 述 微分 方程 计算 : 


fi0; 一 a 7， 十 1 


eng,l 


— bo., (4-87) 


其 中 ,J 是 车 轮 的 转动 惯量 ，Tb 是 作用 在 车 轮 i 上 的 制 动 力矩，Teng， 浊 发 动机 发 出 的 驱动 力 短 在 车 轮 i 上 的 分 量 ，b 是 阻尼 系数 ， 车 辆 模型 可 以 写成 
以 下 微分 方程 形式 

EA Et ME (dog 

中 状态 变量 输入 u= [sf 天 ，ie (1，2，3， 信 .T 为 作用 在 车轮 i 上 的 合力 引 ，Tj=Teng iTb, 由 
于 本 书 中 只 考虑 制 动 ， 即 Tong 记 0，Ti= -Tbl。 对 上 式 进行 欧 拉 离 散 化 处 理 ， 得 到 车 辆 模型 离散 方程 


E Ck+1) =fdw d (E(k), u (kK) ) (4-89) 


4.4.2 ”环境 模型 


环境 模型 向 控制 策略 提供 与 本 车 运行 相关 的 道路 环境 信息 ， 推 导出 车 辆 可 以 安全 通过 的 区 域 ， 即 车 辆 的 可 行 域 。 同 4.2.2 节 中 的 分 析 一 致 ， 车 辆 的 可 行 
域 必须 满足 车 辆 的 安全 约束 ， 即 需 满足 以 下 三 个 条 件 。 


1. 车 辆 不 会 越 出 车 道 


ey，ey 表 示 和 车 辆 航向 角 以 及 车 辆 位 置 与 车 道中 心 线 之 间 的 偏 莽 。 和 车辆 的 外 形 用 算 形 表示 ， 和 车辆 质心 到 车 身 前 端的 距离 为 Lf， 到 后 端的 距离 为 Lr， 和 车身 
宽度 为 NW， 设 ey 表示 和 车身 四 个 角 点 与 车 道中 心 线 的 素 直 偏差 .iE{1，2，3， 作 分 别 表示 和 车身 的 左前 、 右 前 、 左 后 、 厂 后 四 个 角 点 。 


en = e， 十 cos( ey) + Lsin(e,) 








0 7cos(e,) + Lsin( ey, ) (4-90) 
ea = Ey + cos(e,) — L,sin(e,) 


W ， 四 
e4 = 6, 一 FCos(ey) — L,sin(e,) 
为 保证 车 辆 不 越 出 车 道 ， 车 辆 与 车 道中 心 线 的 偏差 必须 保持 在 一 定 的 范围 内 ， 即 


Vie |1l1,2,3,4|,e <e.<e (4-91) 


ymmn YI YmMAax 


eymin 和 eymax 为 道路 的 边界 线 ， 由 道路 边缘 、 路 肩 等 决定 。 


2 车 辆 保持 稳定 
车 辆 稳定 性 通常 用 忆 一 及 相 图 表示 [13] ，B 为 车 辆 质心 侧 偏 角 ， 为 保证 车 辆 稳定 ， 质 心 侧 偏 角 应 满足 如 下 关系 : 
B+EB|I=E, (4-92) 


其 中 E1，E2 为 常数 。 当 然 ， 更 理想 的 情况 是 将 轮胎 力 保持 在 线性 区 域内 ， 此 时 普通 驾驶 员 也 有 能 力 对 车 辆 进行 有 效 的 控制 ， 这 可 以 通过 限制 轮胎 侧 偏 
角 的 大 小 来 保证 【141] 。 


Vie {1,2,3,4| ,a (4-93) 


In IT1aA XN 


3. 避 撞 
在 保证 车 辆 不 越 出 道路 以 及 车 辆 保持 稳定 的 前 提 下 ， 避 撞 是 最 主要 的 目的 ， 因 此 和 车辆 的 可 行 域 应 保证 车 辆 不 会 与 障碍 物 友 生 磁 撞 。 


如 图 4-49 所 示 ， 在 s-ey 坐 标 系 中 ， 和 车 辆 形状 用 算 形 表示 ， 行人、 骑 车 人 等 可 用 椭圆 表示 ， 属 于 本 车 车 身上 的 所 有 点 可 用 仿 射 空间 表示 : 


ax+b,=<0 (4-94) 


1 
Qal 1 1 1 A 
i ,b= (6, b,, bs, bs) 


1 1 1 
Ci dy 0 0Q42 


其 中 ， 即 方程 式 (4-94) 中 包含 有 四 个 仿 射 方程 ， 分 别 代表 本 车 千 身 起 形 的 四 条 边 。 


为 了 避 撞 ， 目 车 车 身 矩 形 与 目标 车 车 身 矩 形 应 当 无 交集 ， 即 本 车 车 身上 所 有 点 满足 : 


a,x +b >0 (4-95 ) 


a a a 04 ? ) pa 
el bm b;= (0, by, by, b) 


下 
IX=(s, e,) ,a,= 
< 这 j j 3 j 
Cl12 C22 C32 C42 


其 中 
起 形 的 四 条 边 。 





，j 表 示 编 号 为 的 目标 车 。 同 理 , 方程式 (4-95) 中 包含 有 四 个 仿 射 万 程 ， 分 别 代 表 目 标 和 车 j 车 身 


本 书 中 用 椭圆 表 示 行 人 、 骑 车 人 等 目标 的 形状 ,为 了 避免 与 这 类 目标 友 生 碰撞 ， 本 车 车 身上 的 所 有 点 应 满足 : 


2 2 
(s— $8) (B 一 


2 2 
a 0 


] (4-96) 


其 中 (sk，ey,k) 表示 目标 Kk 中 心 点 坐标 ，ak 表 示 目 标 k 椭 圆 的 长 轴 ，bk 表 示 目 标 kK 椭圆 的 短 轴 。 


综合 道路 保持 、 车 辆 稳定 和 避 撞 三 方面 的 要 求 ， 车 辆 的 可 行 域 可 表示 为 : 

0 

由 离散 车 辆 模型 可 以 得 到 k 时 刻 车 辆 的 安全 约束 为 : 

pg (5 (GO ，u (oO ，k) <0 (4-98) 

为 了 保证 后 续 开 发 的 自动 紧急 控制 策略 的 稳定 性 ， 此 处 对 车 辆 可 行 域 约束 条 件 进行 松弛 ， 松 弛 变量 为 e，e 为 很 小 的 非 负 常数 ， 得 到 |: 


中 (5 (kK), ul(k), k) <le 


e220 (4-99) 


该 约束 方程 定义 了 k 时 刻 车 辆 可 以 安全 通过 的 区 域 的 集合 ， 即 k 时 刻 车 辆 的 可 行 域 ， 记 为 Ck。 


4.4.3 ”驾驶 员 模型 


此 处 研究 驾驶 员 模 型 的 目的 是 对 驾驶 员 的 当前 操作 行为 进行 辨识 ， 并 对 驾驶 员 未 来 的 操作 行为 进行 估计 ， 表 结合 车 辆 的 动力 学 模型 ,估计 得 到 车辆 的 
预期 轨迹 。 


根据 车 辆 模型 & (k+1) =fwd (E(k) ，u (k) ) ， 设 t 时 刻 车 辆 的 状态 E(t) 能 够 通过 测量 或 状态 估计 得 到 ， 驾 驶 员 在 t 时 刻 的 输入 为 u(t) 。 我 们 
通过 驾驶 员 模型 ， 可 以 估计 得 到 t 时 刻 后 k 个 采样 时 刻 驾 驶 员 的 输入 为 ut+k t。 此 处 需 注 意 区 分 不 同 的 符号 所 代表 的 含义 ，ut+k 读 示 根据 t 时 刻 驾 驶 员 的 输 
入 并 结合 驾驶 员 模 型 估计 得 到 t+k 时 刻 驾 驶 员 的 输入 ， 而 u (t+k) 表示 驾驶 员 在 t+k 时 刻 的 实际 输入 。 因 此 ， 驾 驶 员 从 t 时 刻 到 t+k 时 刻 的 估计 输入 序列 为 
Ut={fut tut+1T t，…，Ut+k, 十 其 中 ut t=u (t) 。 结 合 车 辆 模型 ， 可 得 到 车 辆 从 t 时 刻 到 t+k 时 刻 的 预 估 轨 人 迹 为 : Tt={f&t t，&t+1T tp，&t+k te 


通常 情况 下 驾驶 员 模 型 无 法 对 驾驶 员 行 为 进行 精确 的 表述 ， 而 是 存在 一 定 的 误差 ， 因 此 本 书 引 入 集合 = 表示 和 车辆 轨迹 的 集合 ， 即 : 
3:={2ER™K | p (TtE2) >1-a} (4-100) 


取 Q=0.05， 表 示 和 车辆 的 轨迹 有 95% 的 可 能 性 包含 在 集合 = 内 。 


4.4.4 制 动 转 同 协调 避 揪 控制 


t+k 
大 
从 册 刻 到 t+ k 时 刻 车 辆 的 可 行 域 集合 为 《 = UJ, c ， 如 果 和 驾驶 员 的 预期 操作 正确 ， 和 车 辆 的 预期 轨迹 集合 = 将 保持 在 车 辆 可 行 域 C 中 ， 即 =eC。 如 果 


车 辆 预期 轨迹 越 出 了 车 辆 可 行 域 ， 即 =NCz#0O 时 ,说 明 驾 驶 员 的 行为 存在 不 当 之 处 ， 需 要 通过 预警 或 控制 介入 对 驾驶 员 的 行为 进行 纠正 ， 保 证 车 辆 的 安全 
性 。 因 此 ， 控 制 输入 是 车 辆 预期 轨迹 和 车 辆 可 行 域 的 为 数 ， 即 控制 输入 为 : 

uc (t) =f, (GE，c) (4-101) 

本 书 开 友 的 制 动 转向 协调 吉 撞 控制 的 特点 是 ， 根 据 驾 驶 员 模 型 和 环境 模型 估计 驾驶 员 的 操作 是 否 会 导 人 致 事故 ， 如 果 发 现 有 存在 发 生 事 故 的 可 能 性 ， 则 
通过 控制 输入 对 驾驶 员 的 操作 进行 纠正 和 补偿 ， 保 证 车 辆 的 安全 性 。 控 制 问 题 可 以 转换 为 模型 预测 控制 (MPC) 的 问题 ， 模 型 预测 控制 对 于 处 理 避 撞 这 类 
多 约束 的 非 线性 最 优化 问题 有 其 独 有 的 优势 。 如 图 4-50 所 示 ， 在 每 个 采样 时 刻 ，M PC 计算 一 个 约束 有 限时 间 的 最 优 控制 问题 (Constrained Finite Time 
Optimal Control Problem，CFTOC) 得 到 一 个 最 优 控制 序列 ， 但 只 将 该 控制 序列 的 第 一 个 值 作为 系统 输入 ， 在 下 一 采样 时 刻 重 复 进 行 该 过 程 ， 实 现 滚动 
优化 [>] 。 


一 估计 输出 值 zrkr 
i : 


wD “预测 控制 输入 


1 i+l] [十 人， Es 
人 
---------- 人 ee 
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ult+1) 
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图 4-50 ”模型 预测 控制 示意 图 


在 任意 采样 时 刻 t， 可 构建 如 下 最 优化 问题 求解 控制 输入 : 


‘pT 2 5 
min >》 uw) + Au +Ae (4-102) 
Ue Li | hk 站 
s. 1. 
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其 中 ， th, "是 在 t 时 刻 预 测 得 到 的 t+k 时 刻 驾 驶 员 的 输入 ，U 表 示 由 于 执行 器 物理 特性 导致 的 控制 输入 约束 ， 而 AU 表 示 控 制 输 入 快慢 约束 ，Np 为 预 


测 区 间 。 这 里 不 设置 参考 轨迹 ， 即 将 4.3 节 中 转向 避 撞 策略 中 的 轨迹 控制 转换 到 区 间 控 制 ， 降 低 对 驾驶 员 各 驶 的 干扰 。R，S， 和 分别 表示 对 控制 输入 、 控 制 
输入 梯度 以 及 柔性 约束 的 从 罚 权重 。 其 中 S 的 权重 相对 于 R 更 大 ， 即 在 保证 将 车 辆 控制 在 可 行 域 的 前 提 下 ， 最 小 化 制 动 或 转向 的 输入 变化 率 ， 符 合 各 驶 员 的 
操作 行为 特性 。 当 各 驶 员 没 有 采取 转向 避 撞 操作 时 ， 以 制 动 控制 为 主 ， 转 向 控制 主要 用 于 保证 车 辆 稳定 性 。 反 之 ， 当 驾驶 员 有 转向 避 撞 操作 时 ， 系 统 以 转 
同 控 制 为 主 ， 制 动 控制 更 多 地 用 于 稳定 性 控制 |。 


d d 


d 
ZL + 1] 1 ? 9 Uu 


d _ | 
= | 六 !+h,! 的 控制 输入 序列 


求解 上 述 方程， 可 以 得 到 在 当前 等 吴 环境 下 对 应 于 等 驶 员 预 测 输入 序列 Us = Wh 


Ur = 1 us ,| 
第 一人 元素 作为 系统 往 入 ， 在 t+ 1 采 时 ， 重 得 进行 上 过程， 实现 


滚动 优化 。 可 以 看 出 ， 如 果 各 驶 员 输 入 已 经 能 够 把 车 辆 控制 在 安全 域内 ， 则 控制 输入 为 零 。 


4.5 ”本 童 小 结 


本 章 在 AEB 制 动 避 撞 策略 的 基础 上 引入 转向 控制 ， 构 成 了 目 动 各 驶 紧急 避 撞 控制 策略 ， 主 要 内 容 包括 : 


付 


瑟 司 


(1) 本 章 从 避 撞 所 需 最 短 纵向 距离 、 安 全 收益 、 环 境 感 知 以 及 执行 器 等 方面 对 转向 避 撞 的 效能 和 可 行 性 进行 了 分 析 。 结 果 表明 ， 在 相对 速度 较 高 、 
着 系数 较 小 、 避 撞 所 需 的 侧 向 位 移 较 小 等 工 况 下 ， 转 向 避 撞 所 需 的 纵向 距离 比 制 动 避 撞 要 小 ， 因 此 在 制 动 无 法 避免 磁 撞 时 还 可 以 通过 转向 进行 避 撞 。 同 
时 ， 当 碰撞 无 法 避免 时 ， 通 过 转向 控制 还 能 够 调整 页 撞 位 置 和 磁 撞 角度 ， 为 减轻 辜 撞 提供 了 新 的 途径 。 另 外 ， 当 前 环境 感知 技术 以 及 执行 器 拷 术 的 友 展 已 
经 能 够 满足 转向 避 撞 控制 的 需要 。 


(2) 根据 荨 驶 员 避 撞 行 为 特性 ， 本 章 结合 车 辆 模型 对 转向 避 撞 和 制 动 避 撞 的 临界 避 撞 距离 进行 了 分 析 ， 得 到 了 过 驶 员 的 避 撞 极限 ， 作 为 紧急 转向 控制 


中 危险 估计 的 基础 。 


(3) 本 章 提 出 了 基于 场景 的 转向 避 撞 路 径 规 划 方 法 ， 首 先 通过 高 斯 伪 谱 法 求解 最 优 控制 问题 ， 得 到 特定 类 型 场景 下 特定 初始 条 件 时 的 转向 避 撞 路 径 并 
构成 路 径 复 ， 然 后 根据 当前 场景 的 类 型 和 初始 参数 ， 通 过 克 里 金 插值 方法 在 路 径 复 中 插值 得 到 当前 场景 的 转向 避 撞 路 径 。 


(4) 针对 转向 避 撞 时 是 否 会 占用 其 他 车 道 ， 本 章 在 AEC 控 制 理论 中 引入 了 忽 驶 员 触 友 型 紧急 转向 辅助 以 及 矫正 型 紧急 转 回 辅助 两 种 控制 荣 略 。 当 需要 
占用 其 他 车 道 时 ， 由 驾驶 员 的 转向 避 撞 行为 作为 触 友 条 件 ， 然 后 系统 通过 转向 控制 帮助 驾驶 员 避 撞 。 当 转向 避 撞 在 本 车 道 束 能 完成 时 ， 矫 正 型 沦 急 转向 畏 
助 在 各 驶 员 无 法 避 拉 时 自动 介入 ， 帮 助 驾驶 员 回 避 页 撞 。 两 种 策略 都 采用 前 馈 加 PID 反 馈 的 路 径 跟 路 方法 。 


(5) 本 章 对 AEB 策 略 进 行 了 优化 。 根 据 驾 驶 员 避 撞 极限 分 析 结 果 ， 可 确定 任意 工 况 下 的 临界 TTC 值 ， 从 而 调整 通过 和 们 化 计算 得 到 的 临界 TTC 值 ， 使 得 
系统 介入 的 可 靠 性 更 局 。 另 外 ， 在 没有 转向 避 撞 空间 时 ， 根 据 切 驶 员 的 临界 避 撞 距离 分 析 ， 可 以 更 早 地 触 友 AEB 的 介入 ， 使 制 动 避 撞 的 效能 最 大 化 。 


(6) 本 章 将 AEB 探 制 策 略 和 本 书 中 提出 的 紧急 转向 控制 策略 相 结 合 ， 构 建 目 动 吕 驶 紧急 避 撞 体系 ， 同 时 对 制 动 和 转向 协调 避 撞 控制 策略 进行 理论 推 


和 


\ 
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第 5 草 ”智能 汽车 的 导航 定位 技术 


智能 汽车 的 定位 是 根据 智能 汽车 车 载 传感器 所 采集 到 的 信息 ， 结 合 高 精 地 图 (High Definition Map，HD Map) 、 地 理 信息 系统 (Geographic 
Information System，GIS) 等 完成 车 辆 在 三 维 空间 中 位 置 的 准确 定位 。 它 是 环境 感知 的 重要 部 分 ， 是 智能 汽车 的 一 项 关键 技术 。 只 有 实现 车 辆 的 准确 定 
位 才能 实现 对 智能 汽车 的 决策 、 路 径 规 划 和 控制 。 常 见 的 定位 方法 有 : 地 图 匹配 、 地 面 无 线 电 定位 、 般 位 推算 术 (Dead Reckoning，DR) 、 视 党 定位 和 
全 球 定位 等 。 【1] 一 般 而 言 ， 仅 采用 单一 定位 方式 无 法 满足 智能 汽车 定位 的 需求 ， 所 以 在 实际 使 用 中 常常 将 几 种 定位 方式 组 合 起 来 ， 通 过 不 同 定位 方式 的 
互补 来 实现 汽车 的 准确 定位 。 本 章 首先 介绍 了 高 精 地 图 的 相关 内 容 及 其 在 智能 汽车 中 的 应 用 ， 然 后 介绍 了 GPSs 和 DR 组 合 导 航 定 位 方法 以 及 视觉 里 程 计 技 
术 。 


5.1 基于 高 精 地 图 的 匹配 定位 瓜 术 


高 精 地 图 是 智能 汽车 发 展 的 有 力 支 撑 ， 在 汽车 的 定位 、 环 境 感 知 辅助 和 路 径 规划 等 方面 发 挥 着 重要 的 作用 。 本 节 将 介绍 高 精 地 图 的 基本 知识 ， 然 后 介 
绍 高 精 地 图 的 应 用 以 及 制作 过 程 ， 最 后 介绍 高 精 地 图 的 未 来 友 展 和 挑战 。 


5.1.1 高 精 地 图 VS 传统 导航 地 图 


高 精 地 图 是 对 车 辆 行驶 三 维 环境 的 建 模 ， 高 精 地 图 中 包含 大 量 的 行车 辅助 信息 ， 包 括 路 面 的 几何 结构 、 标 示 线 位 置 、 周 边 道路 环境 的 3D 点 云 模 型 等 ， 
是 一 种 精度 可 达 厘 米 级 别 的 地 图 形式 ， 如 图 5-1 所 示 。 高 精 地 图 按 数据 结构 分 主要 有 矢量 型 和 网 格 型 两 种 ， 前 者 以 矢量 的 形式 将 各 对 象 的 位 置 存 储 在 高 精 地 
图 中 ， 数 据 的 精度 高 ， 具 备 严密 的 数据 结构 ， 数 据 量 较 小 ， 能 够 完整 地 描述 空间 关系 “| 。 而 后 者 将 道路 环境 扫描 后 以 网 格 和 3D 点 云 的 形式 存储 在 地 图 
中 ， 数 据 结 构 简 单 ， 其 网 格 的 大 小 取决 于 制作 地 图 所 采用 的 传感器 的 最 局 精度 。 


Google 高 德 Mobileye 
We Mobileye REM 


传感器 : 摄像 头 + 区 
激光 雷达 | 
| >》 eo 数据 : 车 道 模型 + 上 









= 
激光 点 云 + 矢量 数据 有 独立 HAD 地 图 


图 5-1 典型 高 精 地 图 表达 形式 


高 精 地 图 与 传统 电子 导航 地 图 的 不 同 之 处 在 于 ， 高 精 地 图 的 使 用 对 象 是 自动 驾驶 系统 (Automatic Driving System，ADS) 。 在 目前 的 技术 条 件 
下 ，ADS 不 能 够 灵活 地 应 对 地 图 和 行驶 环境 的 差异 ， 为 了 保证 车 辆 行驶 安全 ，ADS 对 于 地 图 的 精度 要 求 较 高 ， 而 导航 地 图 是 对 道路 网 络 的 一 种 抽象 ， 只 需 
要 表达 各 道路 之 间 的 连接 关系 ， 不 需要 过 多 地 标注 出 车 道 线 和 道路 指示 线 等 详细 信息 ， 导 航 地 图 的 使 用 对 象 是 各 驶 员 ， 他 们 对 地 图 的 精度 要 求 较 低 。 高 精 
地 图 和 普通 电子 导航 地 图 的 对 比如 表 5-1 所 示 。 


表 5-1 高 精 地 图 和 普通 电子 导航 地 图 的 对 比 


传统 电子 导航 地 图 高 精 地 图 





所 属 系统 | ”信息 娱乐 系统 车 载 安全 系统 
( 续 ) 
传统 电子 导航 地 图 高 精 地 图 
定位 显示 、 目 标 索引 、 路 | ”辅助 车 辆 感知 、 定 位 、 车 道 级 路 径 规划 以 及 车 辆 
~ 径 计算 规划 、 路 径 引导 控制 
由 道路 、 背 景 、 注 记 和 
和 贡 开 | ， 征 李 道 模型 、:j 
ee 、 吝 细 的 道中 二 纹 术 包括 车 道 模 型 、 道 路 部 件 、 


图 像 储 存 
精度 低 ， 有 相应 的 法 规 标 
发 展现 状 | 准 ， 技术 比较 成 熟 ， 驾 驶 员 
对 地 图 的 依赖 性 低 


要 求 精 度 局 ， 还 未 形成 统一 的 标准 ， 仍 处 于 探索 
阶段 。 机 器 对 地 图 的 依赖 性 高 





目前 业界 普遍 认为 在 LO ~ L2 级 (SAE 标准 ) 阶段 主要 是 要 实现 一 些 辅助 性 的 自动 驾驶 功能 ， 系 统 不 需要 高 精 地 图 ; L3 级 及 以 上 就 需要 高 精 地 图 的 支 
撑 。2016 年 7 月 初 特 斯 拉 在 Autopilot 模 式 下 在 高 速 出 口 臣 道上 撞 上 了 侧 防护 栏 ， 导 致 了 交通 事故 ， 这 次 事故 发 生 的 一 个 重要 原因 就 是 该 系统 过 多 地 依赖 视 
觉 信息 ， 缺 少 高 精 地 图 的 支持 与 辅助 ， 无 法 准确 实现 在 道路 上 的 高 精 定位 以 及 对 道路 信息 的 获取 。 上 1 现在 大 多 数 智能 汽车 企业 正在 实现 向 更 高 自动 驾驶 
等 级 的 跨越 ， 需 要 高 精 地 图 的 大 量 制作 和 技术 的 大 力 友 展 ， 来 文 撑 更 高 级 别 的 智能 汽车 技术 的 发 展 。2016 年 10 月 高 德 宣布 将 在 智能 汽车 开发 测试 阶段 免费 
为 合作 伙伴 提供 高 精 地 图 ， 高 德 公司 希望 通过 这 样 一 种 跨 界 的 合作 来 推动 整个 产业 的 合作 和 智能 汽车 商业 化 的 落地 。 [9 


5.1.2 高 精 地 图 的 绘制 与 测评 


高 精 地 图 的 制作 过 程 就 是 一 个 多 传感器 信息 融合 的 过 程 ， 其 通过 地 图 采集 车 的 各 种 传感器 进行 数据 采集 ， 建 立 对 行驶 环境 的 三 维 模型 。 制 作 过 程 一 般 
包括 原始 数据 的 采集 、 对 象 标识 、 实 车 测试 和 误 大 分析 等 过 程 。 其 过 程 如 图 5-2 所 示 。 


弟 用 的 数据 采集 传感器 有 GPS3、1IMU、 激 区 雷达 和 相机 等 ， 所 及 集 到 的 原始 数据 包括 高 精度 的 运动 轨迹 、 激 光 雷 达 点 云 和 相机 的 图 像 等 ， 传 感 嚣 的 组 
合 方案 决定 了 高 精 地 图 的 精度 和 质量 。 所 有 传感器 需 进行 联合 标定 ， 保 证 各 传感器 对 环境 形成 唯一 确切 的 摘 述 。 数 据 采集 后 ， 我 们 需要 对 各 个 对 象 进行 识 
别 和 标注 ， 过 滤 和 删除 挥 一 些 无 关 的 数据 。 数 据 标 示 的 过 程 一 般 采 用 深度 学 习 的 算法 ， 该 方法 具有 速度 快 、 准 确 率 高 、 成 本 低 等 特点 。 当 图 像 或 者 点 云 识 
别 的 效果 不 佳 时 ， 可 以 结合 人 工 标注 方法 ， 来 保证 识别 的 准确 性 。 高 精 地 图 完成 后 需要 进行 实 车 测试 ， 通 过 对 比 实际 行驶 环境 和 制作 的 高 精 地 图 ， 来 评价 
和 估计 高 精 地 图 制作 的 质量 。 精 度 接 述 可 以 借助 测量 工具 ,及 用 实际 路 测 的 方法 来 评价 ， 保 证 相对 精度 在 允许 的 可 接受 汽 围 内 。 
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图 5-2 ”高 精 地 图 的 制作 过 程 (高 德 公司 ) 


5.1.3 ”基于 高 精 地 图 三 维 点 云 的 车 辆 匹配 定位 万 法 


激光 雷达 扫描 车 辆 的 行驶 环境 产生 3D 点 云 ， 然 后 利用 这 个 点 云 和 制作 好 的 高 精 地 图 点 云 进 行 匹 配 ， 就 可 以 完成 对 车 辆 的 定位 Pl。 所 以 问题 就 转换 成 了 
两 组 点 云 的 匹配 问题 ， 求 相应 的 旋转 和 平移 矩阵 使 得 源 点 云 和 目标 点 云 重 合 。 其 关系 可 表示 如 下 : 

p=R:p'+t (5-1) 

其 中 p 和 p' 为 目标 点 云 与 源 点 云 的 3D 坐 标 ，R、t 为 所 求 的 两 组 点 云 变 换 的 旋转 和 平移 矩阵 。 但 在 实际 中 目标 点 云 和 源 点 云 的 匹配 总 会 存在 一 定 的 误 
差 ， 定 义 单 点 的 误差 为 : 


e,=p,-—-(R.p. +t) (5-2 ) 
当 氮 的 误差 e 小 于 一 定 的 阀 值 或 为 零 时 ， 则 认为 这 两 个 氮 为 对 应 点 ， 一 般 阅 全 的 设置 应 该 小 于 传感器 的 最 低 精度 。 


所 云 匹 配 一 般 分 为 粗 匹 配 和 精 匹 配 两 步 ， 粗 匹配 束 是 要 完成 对 和 车辆 位 置 的 大 概 匹 配 ， 找 出 大 概 的 R 和 tt 的 变换 和 矩阵 。 粗 匹配 可 以 借助 激光 雷达 扫 摘 到 的 
特征 对 象 和 高 精 地 图 完成 大 致 的 匹配 ， 还 可 以 结合 GPS、Gls 等 系统 完成 大 致 的 定位 。 粗 匹配 主要 借助 于 一 些 搜索 算法 ， 对 全 局 对 象 进行 搜索 匹配 。 精 匹配 
一 般 所 采用 的 算法 是 最 近 氮 迭代 法 (lterative Closest Point，ICP) 和 一 些 改进 的 ICP 算 法 ， 访 方法 在 实现 3D 点 云 匹配 上 有 不 错 的 效果 。 标 准 ICP 算 法 采用 
了 点 对 应 准则 ， 其 核心 思想 可 以 归纳 为 如 下 两 步 : 根据 最 近 点 规则 确定 两 点 云 中 关联 点 对 ; @ 根 据 得 到 的 关联 点 对 ， 求 解 最 佳 位 姿 变换 关系 。 [9] 重复 
上 述 迭 代 计 算 过 程 即 可 最 终 收 敛 于 所 需 的 变换 。 在 迭代 过 程 中 存在 两 个 变量 : 旋转 平移 矩阵 和 点 云 的 位 置 。 在 每 次 的 运算 过 程 中 固定 其 中 一 个 变量 来 计算 
另 一 个 变量 ， 依 次 迭代 下 去 求 得 满足 要 求 的 R 和 t， 完 成 点 云 的 匹配 。 下 面 将 介绍 经 典 的 ICP 算 法 的 推导 过 程 (省 。 


由 式 (5-1) 可 知 整个 点 云 的 匹配 误 产 ， 用 每 个 点 的 误 磊 的 二 范 数 平方 和 表示 。 目 标 浮 数 为 : 


hy hh 


min/ = ~— ,lp-(R:.p'+?i)| ws 


定义 扎 云 的 质心 坐标 为 : 


了 


(p;) 和 P ”= (p;) (5-4) 


=] i=] 


P= . 
L 
定义 去 质心 坐标 为 : 


4 = p: -pHg;: =p; -Pp (5-5) 


将 式 (5-3) 展开 后 ， 把 式 (5-4) 代入 整理 得 到 |: 


| 1] < 有 
min, 一 py Ip, ~-p-Rp -pi + lp-Rp’ -tl (5-0 ) 


二 


这 里 可 以 把 优化 问题 看 成 两 部 分 ， 右 边 第 一 项 只 和 R 有 关 ， 使 该 项 最 小 即 可 求 得 R。 这 里 的 求解 可 以 使 用 VD 解法 或 者 使 用 非 线 性 优化 的 Bundle 
Adjustment 算 法 。 辆 数 天 系 为 : 


* 。 下 / 2 S 
R = arg min 7 > lo -Ra’ | (5-7 ) 


| 
右边 第 二 项 和 R 与 t 都 有 天 ， 由 于 它 是 平方 故 让 接 令 其 等 于 零 ， 即 可 使 得 右边 两 项 和 最 小 ， 故 可 以 把 t 求 出 来 。 


根据 得 到 的 Rt 就 可 以 不 停 地 达 代 ， 直 到 和 迭 代 误 差 小 于 设 定 值 时 即 终止 迭代 过 程 。 根 据 达 代 产生 的 最 优 旋 转 矩 阵 R 和 平移 矩阵 t， 对 点 云 进 行 刚 体 变 
换 ， 得 到 最 终 配 准 结果 (3] 。 当 然 这 里 迭代 误差 的 大 小 也 应 该 小 于 传感器 的 最 小 精度 。 通 过 |CP 算 法 完成 两 组 点 云 的 精 匹 配 ， 从 而 实现 扫描 点 云 和 高 精 地 
图 点 云 的 对 应 ， 进 一 步 可 以 算得 车 辆 的 准确 位 置 ， 其 定位 精度 可 以 达到 过 代 的 精度 。 


5.1.4 ”高 精 地 图 的 未来 友 展 与 挑战 


欧洲 导航 地 图 公司 TomTom 宣 布 其 高 精 地 图 已 覆盖 美国 本 土 州 际 路 网 ;百度 称 其 高 精 地 图 精度 可 达 厘 米 级 别 ， 可 实现 90% 的 自动 化 制作 流程 ; 高 德 获 
得 了 国内 第 一 个 关于 高 精 地 图 的 商业 订单 [9] ; 四 维 图 新 入 股 地 图 制造 商 Here， 并 在 国内 成 立 相应 的 合资 公司 [10] 。 高 精 地 图 正成 为 智能 汽车 产业 中 的 
热门 ， 但 同时 高 精 地 图 的 发 展 也 面临 着 多 重 挑战 。 


(1) 标准 问题 : 目前 ， 各 家 地 图 生产 企业 都 按 自 己 的 标准 生产 高 精 地 图 ， 所 以 制作 的 高 精 地 图 也 是 各 种 各 样 ， 相 互 之 间 并 不 兼容 。 其 主要 原因 是 制图 
的 生产 商 所 采用 的 传感器 方案 不 同 ， 而 传感器 方案 在 很 大 程度 上 决定 了 高 精 地 图 的 “模样 ”。 因 此 应 尽快 规范 高 精 地 图 的 相关 标准 ， 加 速 高 精 地 图 技术 的 
发 展 。 


(2) 更 新 问题 : 由 于 高 精 地 图 在 智能 汽车 中 扮演 着 十 分 重要 的 角色 ， 所 以 应 保证 高 精 地 图 在 实际 道路 发生 变化 时 及 时 更 新 ， 这 仪 仪 依靠 地 图 公司 对 地 
图 进行 实时 更 新 显然 并 不 现实 。 因 此 ， 需 要 更 多 地 借助 社会 化 的 车 辆 ， 比 如 物流 车 、 公 交 车 、 出 租车 等 。 未 来 地 图 产业 一 定 是 一 种 众 包 更 新 形式 ， 每 个 车 
都 具有 数据 采集 上 传 的 功能 。 


(3) 法 规 问 题 : 出 于 对 安全 的 考虑 ， 国 家 测绘 局 对 传统 导航 地 图 都 会 进行 仿 转 加 密 处 理 ， 使 得 实际 的 地 理 位 置 和 地 图 上 看 到 的 地 图 坐标 间 存 在 一 定 的 
偏 拔 ， 并 不 完全 相同 。 由 于 高 精 地 图 对 于 道路 的 测量 更 加 精确 ， 包 售 了 大 量 道路 的 静态 信息 ， 因 此 国家 测绘 局 也 需要 在 国家 政策 限制 和 汽车 自动 驾驶 产业 
需求 间 做 出 平衡 。 这 残 需要 政府 、 汽 于 企业 和 地 图 商家 等 一 起 积极 沟通 ， 合 作 探讨 出 合理 的 测绘 政策 和 审 图 政策 ， 形 成 相关 标准 。 


5.2 ”基于 DR 和 MM 组 合 的 车 辆 定位 方法 


采用 GPS、DR 和 地 图 匹配 (Map Matching，MM) 组 合 定位 方法 改善 车 辆 导航 定位 的 精度 。GPS 定 位 具有 全 球 覆 藉 、 绝 对 定位 精度 高 、 实 时 全 天 候 
定位 等 优 挟 。 由 于 无 线 信号 从 2 万 干 米 的 上 空 友 射 ， 到 达 地 面 时 能 量 很 弱 ， 无 法 穿 透 障 碍 物 ， 因 此 高 楼 、 桥 梁 、 隧 道上 甚至 树 前 的 遮挡 都 会 影响 信号 的 正常 接 
收 。 在 现代 城市 交通 环境 中 ， 道 路 两 旁 的 高 楼 大 厦 林立 ， 车 辆 经 常 需要 穿 过 立交 桥 和 隧道 ， 造 成 许多 GPS 盲 区 。DR 定 位 采用 惯性 器 件 和 里 程 传感器 的 相对 


定位 方法 ， 具 有 完全 自治 性 、 动 态 响 应 快 的 优点 ， 在 短 时 间 内 的 定位 精度 高 。 


在 GPS 信号 短 时 恶化 的 情况 下 ， 采 用 GPS/DR 组 合 定位 能 够 取得 较为 满意 的 定位 精度 。 【11] 陆地 车 辆 一 般 在 道路 上 行驶 ， 然 而 由 于 多 种 误差 的 影 
响 ，GPS/DR 的 定位 结果 可 能 不 在 电子 地 图 的 交通 路 网 上 ， 需 要 由 地 图 匹配 解决 传感器 定位 信息 到 实际 道路 上 的 映射 。 随 着 近年 来 城市 建设 中 高 楼 、 高 染 
和 隧道 的 增加 ， 在 实际 使 用 过 程 中 ，GPS 定 位 经 常 出 现 信 号 丢失 或 定位 精度 近 化 等 问题 。 与 此 同时 ， 随 着 电子 地 图 厂商 对 电子 地 图 制作 投入 的 加 大 ， 电 子 
地 图 精度 有 较 大 的 改善 ， 市 区 定位 精度 可 达到 5 ~ 10m 左 右 。 和 蛤 于 上 述 分 析 ， 本 节 对 DR 和 MM 组 合 定位 拷 术 进行 研究 ， 以 改善 较 长 时 间 无 GPS 信 号 时 的 定 


位 精度 问题 。 


5.2.1 ”舱位 推算 技术 


航 位 推算 (DR) 技术 最 早 应 用 于 水 下 导航 系统 ， 是 一 种 比较 经 典 的 导航 定位 算法 。 后 随 着 微机 电 系 统 技术 的 发 展 ， 导 航 传感器 的 成 本 不 断 下 降 ， 它 被 
引入 到 车 辆 导航 定位 中 。 [1<] 其 工作 原理 如 图 5-3 所 示 [1-13] 。 


VY 


图 5-3” 航 位 推算 原理 图 


在 图 5-3 中 ，xg、yo、90 为 车 辆 在 to 时 刻 的 初始 位 置信 息 ， 一 般 可 以 通过 GPS 得 到 ; dj; 为 车 辆 在 t 到 ti;1 时 间 内 行驶 的 距离 ;0 为 车 辆 在 ti 时 刻 的 航向 
角 ; 则 在 任意 时 刻 tn， 车 辆 的 位 置 为 : 


nl 


XX 三 Xo 十 > d.cosQ. 


i 二 | 


nl 


yo 十 > d.sing. (5-8) 
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nl 


0 + >》0 
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|| 


当 实 际 中 采样 周期 1 一 定 且 较 小 时 ， 可 以 把 一 个 时 间 周 期 内 的 速度 、 角 度 变化 看 成 线性 变化 ， 即 有 : di=viT，6i=wiT， 则 上 陈 可 变 形 为 : 


n—l1 


证 7 > 27,COSO， 


i=0 


nl 


Yo 十 7 > vs1n0. (5-9) 
i=0 


:区 
~ 
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nl 


0, = 0 + 了 >》 0 
i=0 


由 上 述 两 个 式 子 可 知 ， 只 需要 测量 车 辆 的 距离 d 和 和 航向 角 9 或 者 速度 v 和 角速度 Ww 即 可 算得 车 辆 的 位 置信 息 。 


DR 常用 的 传感器 包 合 测 距离 和 测 航 向 角 两 类 。 测 距离 类 传感器 包括 里 程 计 、 加 速度 计 等 。 其 中 里 程 计 通 过 记录 车 轮转 动 的 圈 数 来 测量 距离 ， 比 较 万 便 
简单 ， 成 本 低 ， 但 其 测量 精度 也 较 低 ， 受 到 车 轮 的 充气 压力 、 磨 损 程 度 、 车 辆 载重 、 运 动 中 车 轮 的 滑动 等 外 界 因素 的 影响 。 [4] 加 速度 计 是 通过 测量 运动 
物体 的 加 速度 ， 经 过 两 次 积分 可 以 得 到 位 移 。 其 体积 小 、 成 本 低 、 安 委 方 便 ， 且 不 受 外 界 环 境 的 干扰 和 影响 ， 所 以 它 也 经 单 被 选择 作为 测量 速度 的 传 感 
器 。 但 是 加 速度 计 元 件 本 身 仔 在 一 些 误 差 ， 即 使 经 过 补偿 误差 仍然 不 能 完全 消除 ， 在 长 时 间 的 使 用 过 程 中 ， 误 差 不 断 被 累积 导致 定位 导航 精度 下 降 而 无 法 
可 靠 地 工作 。 


测 航 向 角 类 传感器 一 般 包 括 磁 罗 盘 、 磊 分 里 程 计 、 陀 螺 仪 等 。 其 中 ， 磁 罗盘 是 借助 罗盘 中 磁 针 指向 不 变 来 测量 车 辆 的 航 偏 角 的 ， 其 质量 可 靠 、 价 格 便 
宜 。 不 过 由 于 地 磁力 较 小 ， 因 此 它 容易 受到 外 界 磁场 的 影响 。 兰 分 里 程 计 是 扬 在 无 右 两 个 后 轮 上 平行 地 安 和 里 程 计 ， 在 汽车 转弯 时 ， 通 过 两 个 里 程 计 测 得 
的 距离 不 同 ， 从 而 得 到 航向 的 变化 。 陀 螺 仪 主要 是 根据 惯性 定理 制 成 的 ， 可 以 测 得 物体 的 角速度 和 角 位 移 。 和 加 速度 计 一 样 ， 陛 螺 仪 不 受 外 界 环 境 的 影 
啊 ， 都 仓 企 本 身 的 误差 ， 经 过 积分 后 误差 书 放 大 ， 且 误差 随 背 时间 的 加 长 而 累积 ， 所 以 只 能 实现 短 时 间 内 的 可 靠 测量 。 


5.2.2 ”地 图 匹配 技术 


1. 地 图 匹配 的 一 般 过 程 
完整 的 地 图 匹配 算法 由 三 个 过 程 构成 : 
(1) 确定 误差 区 域 学 围 ， 搜 索 候选 路 段 。 
(2) 选择 正确 路 段 ， 计 算 车 辆 在 道路 上 位 置 。 
(3) 估计 传感器 误差 ， 修 正 传感器 定位 输出 。 


地 图 匹配 首先 要 确定 候选 道路 的 搜索 范围， 选择 适当 大 小 的 区 域 很 重要 ， 过 大 的 误 话 区域 会 增加 道路 搜索 和 道路 匹配 的 计算 量 ， 而 区 域 过 小 则 可 能 焉 
漏 正确 的 道路 。 一 般 按照 概率 准则 定义 误差 区 域 ， 即 误 关 区域 以 一 定 的 概率 包括 后 辆 的 实际 位 置 。 假 设 定位 系统 的 协 方差 阵 定 义 为 : 


UO, C 
P= | (5-10) 


yp 2 


其 中 0。 和 "分别 为 传感器 在 东 向 和 北向 的 均 方差 Gen 是 协 方才 ， 按 下 陈 定 义 定 位 误 郑 椭圆 : 








= 0 VS3xlog +o -VCog -oa) +40,) (311) 


] 20 
Dp = Fatan | 
2 0, — 0, 
其 中 a 是 椭圆 长 半 轴 ，b 是 椭圆 短 半 轴 ， 中 是 椭圆 长 半 轴 与 正 东 向 的 夹 角 ， 椭 圆 中 心 是 当前 传感器 的 定位 。 0 0 是 单位 权 值 的 后 验方 差 ， 改 变 @ 0 的 什 
yo =2.1 
以 调整 误差 椭圆 的 大 小 ， 从 而 获得 不 同 的 可 信和 度 。 假 设 定 位 误差 服从 正 态 分 布 ， “0 ”可 以 获得 95% 的 可 信 度 . 为 了 简化 边界 的 判别 ， 在 实际 算 


法 中 ， 通 常 采用 和 矩形 定义 误差 区 域 范围 。 

定位 误差 椭圆 确定 后 ， 从 电子 地 图 中 搜索 误差 椭圆 范围 内 的 路 段 作为 候选 路 段 ， 然 后 从 候选 路 段 中 确定 当前 行驶 路 段 。 道 路 匹配 的 基本 输入 信息 有 传 
感 器 定位 点 与 道路 的 距离 、 车 辆 航向 与 道路 方向 、 道 路 连续 性 ， 当 采用 三 维 地 图 时 ， 道 路 的 海拔 也 可 作为 复杂 立交 道路 的 判断 依据 。 常 见 的 地 图 匹配 算法 
有 位 置 点 匹配 [1?] 、 轨 迹 相关 算法 【10] 、 基 于 模式 识别 的 方法 【1 、 模 糊 理论 的 匹配 算法 [18] ， 以 及 基于 D-S 证 据 理 论 的 地 图 匹配 算法 [13] 。 这 里 
主要 介绍 基于 D-S 证 据 理 论 的 地 图 匹配 算法 。 


2. 基 于 D-s 证 据 理 论 的 地 图 匹配 算法 


bb 


D-S 证 据 理 论 是 最 先 由 登 普 斯 特 (Dempster) 提出 ， 后 由 谢 砷 (Shafer) 进一步 友 展 起 来 的 一 种 不 确定 推理 理论 。 该 理论 满足 比 概率 论 弱 的 公理 ， 能 
够 区 分 “不 确定 ”与 “不 知道 ”的 差异 ， 处 理由 “不 知道 ”引起 的 不 确定 性 。 本 书 提 出 了 基于 D-Ss 证 据 理论 的 地 图 匹配 算法 ， 如 图 5-4 所 示 。 


当前 路 段 未 知 






搜索 、 匹 配 路 段 
是 否 匹 本 成功? 


当前 路 段 的 文 持 度 和 证 撕 
冲突 程度 检查 





P= 


图 5-4 基于 D-S 证 据 理 论 地 图 匹配 算法 


首先 匹配 过 程 的 状态 为 “当前 路 段 未 知 ”， 根 据 D-S 推 理 规则 从 候选 路 段 中 选择 最 匹配 的 作为 当前 路 段 。 一 旦 确定 当前 路 段 后 ， 在 以 后 的 每 次 匹配 循 
环 中 ， 仅 对 当前 路 段 的 广 持 度 和 证 据 冲 突 程度 进行 检查 ， 知 不 满足 要 求 ， 匹 配 过 程 回 到 当前 路 段 未 知 的 状态 。 这 样 处 理 的 优点 是 避免 每 次 都 搜索 候选 路 段 
并 进行 匹配 计算 ， 降 低 处 理 器 的 计算 负 何 。 


在 误差 区 域 范 围 内 搜索 到 n 条 候选 路 段 ， 分 别 为 S1 (k) ，S? (k) ，S3 (k) ，.…，Sn (k) 
为 d1 (Kk) ,d2 (k) , d3 (kK), ..., dn (k) ; B1 (k) , Bz2 (k) , B3 (Kk) ,..., Bn (k) 。 


匹配 问题 的 识别 框 U 为 : 


U={A1，A?，A3，.…，An，NE，} (5-12) 
其 中 A 表示 路 段 $i;(K) 为 当前 路 段 ，NE 表 示 当 前 路 段 不 在 候选 路 段 中 ， 其 物理 意义 为 ， 车 辆 所 在 的 当前 位 置 不 在 电子 地 图 道路 上 。 


命题 集合 表示 为 : 2U={A1,A2, A3, .…, An, NE, E} 


集合 E=A1UA2UA3..….U AnU NE， 表 示 不 能 确定 当前 路 段 。 


由 下 式 计算 名 子 集 的 mass 函 数 : 








Ci 
m.(k) = a 
| (1 
Ci (k) 
WS [| 
人 = hl hi (5-14) 
ms(k) 三 ks/(l + Ap) 
i = 人 nek) Dm (k) 
和 人 
mB (k) =1 -me(k) - 和 me 人 (有 
i=] 
4 8 


在 式 (5-13) 种 “上 和 全 的 定义 为 : 


l/ld(k) +C 


n 


LZ 证 > l/[d.(k) +C,| 


EA 


/Bys + T/LB(K) + Co 


j= 


C (k) 


d B . 
其 中 括号 内 的 k 雪 示 第 次 匹配 过程， Li 人 万 ) 表 示 由 距 高 下 所 得 8 到 的 对 路 段 5 (k) 的 支持 程度 ， 7 《外 ) 


d 有 B Fk 
Si (k) 的 支持 程度 . mg (kk) em (k) 


mh 
对 于 GPS/DR 组 合 定位 ， 通 常 取 kp 为 较 小 值 ， 以 提高 航向 证 据 的 信任 程度 。 nvgin 
增加 的 支持 子 集 NE 的 距离 和 航向 偏差 证 据 ， 它 们 的 值 由 地 图 精度 和 GPS/DR 定 位 精度 确定 。 引 入 C1 和 C2 党 
感 程度 。 各 候选 路 段 的 联合 支持 度 函 数 定义 为 : 


， 传 感 器 定位 点 与 各 候选 路 段 的 最 短 距离 和 航向 偏差 分 别 


表示 由 航向 偏差 证 据 得 到 的 对 路 段 


分 别 表示 由 距离 和 航向 偏差 证 据 得 到 的 对 候选 路 段 不 确定 的 程度 ， 改 变 kd 和 Kg 能够 调整 证 据 不 确定 的 程度 ， 


““ 表示 证 据 对 当前 路 段 不 在 候选 路 段 中 的 支持 程度 ，dNE 和 和 BNE 为 


单数 因子 ， 以 降低 定位 在 小 误差 情况 下 对 噪声 的 敏 


m(k) = K :Em (hk) mk) + mk) mi(k) + mi(k) :moe(k))] 
(S5-16) 
K =ms(k) . ms(k) 二 > [mm (k) mi (k) +m’(k) .115 (k) + mi (k) 
J=] 
dv 7 d B d bE B B d 
me(k) | tm(k) mk) + mh) me(k) + TAR( 天) mk) 
(S-17) 


选择 mi (k) =max (m1 (kK) ，m2 (Kk),，.…， mn (k) ，mNE (kg ) 的 第 i 个 子 集 对 应 的 候选 路 段 为 当前 路 段 。 


考虑 到 道路 连续 性 ， 对 式 (5-16) 和 式 (5-17) 中 的 支持 度 函 数 做 了 修改 : 


m(k) =K :Em (hk) mi(k) + mk) me(k) + m (kk): 


mos(k)|] +k .m(k—-1) (S-18 ) 
= 他 路桥 为 时 刘 ( 人 1) 的 当前 中 
40 ”其 他 


在 地 图 匹配 中 引入 连续 性 因素 ， 一 定 程度 上 提高 匹配 的 正确 性 ， 但 取 值 不 宜 过 大 ， 人 否则 将 降低 匹配 结果 的 响应 速度 ， 造 成 在 交叉 路 口 的 匹配 延 时 。 


5.2.3 ”基于 卡尔 曼 渡 激 器 的 DR 和 MM 定位 信息 的 融合 


单独 进行 DR 定位 时 ， 由 于 误差 累积 ， 位 置 和 航向 的 估计 是 有 偏 的 。 从 道路 试验 结果 来 看 ，DR 误 差 发散 是 影响 系统 定位 精度 的 主要 因素 。 电 子 地 图 上 
的 道路 信息 在 一 定 条 件 下 近似 为 无 偏 估计 ， 因 此 用 地 图 匹配 校正 DR 误差 具有 更 大 的 现实 意义 。 


经 典 的 卡尔 曼 滤 波 算法 是 匈牙利 数学 家 于 20 世 纪 60 年 代 提出 的 ， 是 一 种 强大 的 线性 滤波 方法 ， 被 广泛 地 应 用 于 机 械 、 航 空 、 通 信 以 及 社会 各 领域 当 
中 。 该 算法 包括 系统 万 程 和 测量 方程 ， 其 中 系统 万 程 反 映 了 系统 的 传递 结构 ， 测 量 广 程 表 明了 被 估计 值 和 测量 值 乙 间 的 函数 天 系 。 本 节 提 出 了 基于 卡尔 曼 
滤波 的 DR/MM 组 合 定位 的 实现 方法 。 





| 


图 5-5 ”地 图 匹配 的 观测 噪声 


1. 地 图 匹配 噪声 


在 地 图 匹配 中 ， 垂 直 于 道路 方向 的 传感器 定位 误差 是 可 观 的 ， 理 论 上 治 道路 纵向 误差 不 可 观 ， 采 用 误差 概率 准则 可 改变 其 可 观 性 ， 通 过 观测 噪声 体现 


(出 图 5-5) Oo 

图 2-6 摘 述 了 地 图 匹配 的 观测 噪声 。 观 测 噪声 cxm 和 aym 用 道路 局 部 坐标 系 xmOmym 摘 述 ， 假 设 观测 噪声 服从 零 均 值 高 斯 日 噪声 分 布 ， 阴 影 椭圆 为 观测 
ey ats 
噪声 椭圆 。noe 为 局 部 南北 坐标 系 ，P 及 P' 在 noe 中 的 坐标 分 别 表示 为 (Pe，Pn) 和 


当道 路 直线 长 度 L 大 于 设 定 阀 值 Lth，oxm 取 一 个 相对 大 值 ， 否 则 由 路 段 长 度 和 地 图 精度 确定 : 


LA [2 hk, ) 十 < L, | / 
Um 一 ] >- >) 
OU MAX 其 他 


横 同 观 测 噪 声 oym 需 要 考虑 实际 的 道路 宽度 以 及 地 图 精度 : 
Oym=W/ (2 :kp) +om (5-20) 


W 为 道路 度 ，Kkp 己 误差 概率 有 天， 取 95% 的 可 信和 度 时 ，kp=2.15。om 为 电子 地 图 误差 ， 在 城市 道路 中 取 15m.。 
2. 卡 尔 曼 滤波 器 设计 


取 状 态 为 DR 定位 在 东 向 、 北 向 的 位 置 误 差 和 航向 误差 : 
R= (Xs Ky Xe + {5-21) 


误 牵 用 一 阶 马 尔 可 夫 过 程 描述 : 


~ 
| 
| 
-~] 
> 


,~ A, 十 CA， 


€ 


A + (5-22) 


Ao 三 一 Th "Ao + w, 
站 ( 0 ， 0 ， OA 、O 
*。 ”和 "和 0 分 别 为 噪声 过 程 时 间 常 数 的 倒数 ， ”^。 ” 《hn ” ”40 为 零 均 信 的 白 噪声 ， 均 方 根 分 别 为 “和 


整个 系统 的 离散 状态 方程 为 : 


X(k+1) = DBD:. X(k) +W(k) ($-23) 
有 = diag| exp( — Be T) | 


T 为 采样 周期 ，WX (k) 为 日 噪声 ， 假 设 各 状态 噪声 互 不 相关 ， 得 到 状态 协 万 磊 阵 : 


diag( qi1 ,9 ,933 ) 


人 
|| 


qu= oll -exp(-2:7, 7) : 

: : ($5-24) 
qz2 = Onll1 - exp(—2°: 7 了) 
d33 一 ol “(2 ag 7) | 


以 地 图 匹配 点 P' 与 DR 定位 点 P 在 东 向 、 北 向 的 偏差 和 航向 偏差 为 观测 值 : 
yr 
] 三。 a 
yp | _ | 
三， P, (3 2 ) 
I 
3 0 -40 


bh 


Z 
Z=|7 
Z 


离散 观测 方程 为 : 


5 


其 中 H=diag (1，1，1，) 。 


Wz (k) 为 观测 噪声 ， 假 设 电 子 地 图 上 位 置 噪声 与 航向 噪声 不 相 天 ， 观 测 噪声 协 方差 阵 R 为 : 


UO em CO enm 0 
2 2 
人 加 CF i 1 0 ( 2 21 ) 
2 
0 1 和 
2 2 2 2 。 2 
a CF COS CQ 十 CO jm * SIN OQ 
2 2 2 7 本 py 
Om OU jm "COS OQ + Om SIN CQ 
2 2 
人 ( FB SE C jm ) 。 COSOQ ， SI1NA 


其 中 a=T/2-9'， 为 道路 与 东 向 的 夹 角 。 
3.DR 误 差 反 馈 


DR 误差 反馈 要 考虑 避免 错误 的 地 图 匹配 结果 产生 的 不 民 影 响 ， 因 此 只 有 当 匹 配 结果 很 可 信 时 ， 才 将 估计 的 误差 部 分 反馈 到 DR 方程 中 。 这 里 利用 “ 当 
前 路 段 文 持 度 和 证 据 冲 突 程度 检查 ”的 结果 确定 是 人 否 对 DR 进行 误 关 反馈， 反馈 方程 为 : 


区 CR | Pp (k) 
Pi |= ||P,(k) | + diag(!/ 


pos 


,1 


“Ps 


,大 )》 » Xk) (S20) 
有 (大 ) 1 0O(k) 


Pe (k) “、Pn (k) “和 6 (k) “为 误差 反馈 后 在 k 时 刻 的 DR 定位 ，kpos 和 Kk6 为 反馈 系数 。 


4. 实 验 结果 与 分 析 


以 某 次 道路 试验 为 例 ， 进 行 离线 试验 。 试 验 的 原始 数据 为 GPS 定位 数据 和 DR 传感器 数据 ， 电 子 地 图 数据 从 一 幅 已 校正 经 纬 坐 标的 扫 摘 地 图 上 提取 ， 除 
保持 原始 道路 的 几何 拓扑 外 ， 还 在 一 些 路 口 虚 建 了 分 又 路 段 ， 以 增加 匹配 问题 的 复杂 性 。 
[二 = TT = (. 2s 7 Li = 0. ls™ ，» OO, 三 


A 


卡尔 曼 渡 波 器 采用 的 参数 如 下 : 
On 一 lm, Us = 3°， Om 一 lm, CO nax 一 100m, Og = ， L, = 300m, hk - 0U. 12 = k, =0. (8 


图 5-6 为 单独 DR 定位 时 的 结果 ， 图 5-7 为 地 图 匹 配 与 校正 结果 。 单 独 DR 定 位 由 于 误 笑 累积， 一 段 时 间 后 ， 航 向 和 位 置 明显 偏离 实际 行驶 道路 。 及 用 
DR/MM 组 合 定位 方法 ， 所 有 轨迹 点 都 落 在 当前 道路 上 。 匹 配 结果 经 卡尔 曼 渡 波 后 反馈 到 DR 方程 ， 校 正 后 的 DR 轨迹 与 电子 地 图 道路 近似 重合 ， 终 点 位 置 与 
GPS/DR 定 位 (位置 参考 ) 相 比 ， 沿 道路 纵向 坐标 偏差 约 2.2m， 航 向 偏差 1 ， 整 个 路 段 长 度 约 6.4km， 行 驶 时 间 883s。 可 见 提出 的 地 图 匹配 校正 DR 方法 能 
够 显著 改善 单独 DR 定位 的 精度 。 


一 一 电子 地 图 道路 
DR 定位 
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图 5-6 汗 狐 DR 定位 结果 
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图 5-7 DR/MM 组 合 定位 结果 


5.2.4 本 节 小 结 
本 节 提 出 基于 卡尔 曼 滤 波 的 DRWMMM 组 合 定位 方法 ， 采 用 D-s 证 据 理论 方法 实现 地 图 匹配 ， 采 用 误差 概率 准则 计算 地 图 匹配 观测 噪声 ， 建 立 卡 尔 曼 滤波 


方程 ， 并 适时 对 DR 方程 进行 修正 。 组 合 定位 试验 表明 ，DR 定 位 精度 得 到 显著 提高 ， 基 本 消除 了 DR 误 医 积累 。 及 用 该 方法 ， 能 够 保证 在 较 长 时 间 内 GPS 信 
号 丢失 时 ， 定 位 系统 仍 可 靠 定位 。 


5.3” 视 完 里 程 计 


车 载 视 竞 里程 计 (VisualOdometry,，VO) 作为 一 种 车 辆 自主 定位 的 方法 ， 依 靠 目 身 图 像 传 感 器 获得 车 辆 所 处 场景 的 信息 ， 通 过 特征 和 运动 估计 和 解 算 
车 辆 的 位 置信 息 。 具 有 完全 的 自主 性 、 高 度 场景 的 适应 性 、 数 据 的 高 效 性 和 融合 的 开放 性 等 特点 ， 是 汽车 智能 化 发 展 的 一 个 重要 方向 。 [<0 


5.3.1 ” 视 沉 里 程 计 概述 
视觉 里 程 计 这 个 名 词 是 由 尼斯 特 尔 (Nister) 在 2004 年 的 论文 中 正式 提出 的 1] ， 这 个 名 词 和 车 轮 里 程 计 非常 类 似 。 相 比 车 轮 里 程 计 ， 视 觉 里 程 计 
的 优势 是 不 受 车 轮 、 路 面 状 况 和 车 辆 载荷 等 的 影响 。 另 外 它 还 能 提供 更 为 精确 的 轨迹 估计 ， 相 对 位 置 误差 范围 为 0.1%~ 2% [<2] 。 


视觉 里 程 计 实现 的 一 般 步骤 为 : 特征 点 提取 、 特 征 点 匹配 和 位 姿 计 算 [0 “1] 。 常 用 的 特征 点 包括 ORB、SURF 和 Harris 角 点 等 上 “3 ~] 。 特 征 点 及 
其 周围 像素 的 信息 可 以 通过 向 量 描述 子 进行 有 效 表达 。 如 果 两 个 特征 点 的 描述 子 相同 或 小 于 一 定 的 阀 值 ， 则 可 认为 这 两 个 特征 描述 了 满足 特征 点 匹配 法 
则 ， 常 用 的 特征 匹配 搜索 方法 有 多 维 搜索 树 或 哈 希 表 等 [26] 。 最 后 ， 通 过 Random 算 法 解 算 多 个 匹配 好 特征 点 间 的 相机 运动 关系 ， 得 到 相机 旋转 (R) 和 
平移 (t) 矩阵 ， 由 此 可 以 得 到 相机 姿态 转移 矩阵 : 


1 nn rp Te 
Cp rr 一 (CC 人 IC (5-29) 


n n b 
Co 、 C, 1 +1] 


a 分 别 为 K 时 刻 和 Kk+1 时 刻 的 姿态 转移 算 阵 ， “ 为 视 党 坐标 系 到 机 体 坐 标 系 的 转移 矩阵 ， 该 距 阵 可 以 通过 标定 获得 ， 可 视 为 单 值 矩 
阵 。 此 时 双 目 视 党 位 姿 估计 可 以 表示 为 : 


n n 171 ib nye | 
em 一 人 时 Cp iCeRe rt gr (5-30) 


Pr PP 
“+ 分 别 为 k 时 刻 和 k+1 时 刻 的 载体 在 导航 系 的 三 维 位 置 。 给 定 载体 姿态 和 位 置 初 值 的 情况 下 ， 根 据 式 (5-29) 和 式 (5-30) ， 即 可 估计 
载体 的 位 姿 信 息 [27] 。 由 于 在 实际 当中 每 一 步 的 计算 都 存在 一 定 的 误差 和 不 确定 性 ， 故 视觉 里 程 计 的 误差 会 随 着 过 程 的 推移 而 逐渐 累积 。 
根据 特征 点 匹配 关系 的 不 同 又 可 以 分 为 以 下 三 种 方式 [28] ， 不 同 的 方式 采用 不 同 的 算法 获得 相机 运动 的 R 和 tt 最 后 来 进行 相机 位 姿 的 估计 。 


(1) 2D-2D 的 匹配 关系 : 通过 两 个 图 像 的 像素 坐标 来 估计 相机 的 运动 ， 与 外 部 的 场景 无 天 ， 仅 根据 两 个 图 像 的 映射 天 系 来 求解 运动 。 一 般 出 现在 单 目 
视 咒 里 程 计 中 。 这 里 可 以 使 用 对 极 几 何 的 方法 来 进行 求解 。 


(2) 3D-2D 的 匹配 关系 : 知道 其 中 一 组 点 的 3D 华 标 以 及 另 一 组 点 的 2D 坐 标 ， 比 如 图 像 和 三 维 地 图 的 匹配 。 可 以 通过 PnP 算 法 求解 相机 的 位 次 ， 它 是 
P3P 算 法 的 扩展 。 


(3) 3D-3D 的 匹配 关系 : 知道 两 组 点 的 3D 坐 标 信息 ， 如 双 目 相机 ， 可 以 通过 三 角 化 获得 图 像 特 征 点 对 应 的 3D 坐 标 。 然 后 使 用 ICP 算 法 进行 相机 位 姿 
的 求解 。 其 工作 原理 在 前 面 已 经 论述 ， 这 里 不 同 之 处 在 于 3D 扣 的 匹配 天 系 已 知 ， 不 需要 再 进 行 3D 点 的 达 代 。 


5.3.2 ”对 极 几 何 


对 极 几何 是 2D-2D 对 应 天 系 中 求解 两 帧 间 相 机 姿态 的 基本 万 法 ， 其 示意 图 如 图 5-8 所 示 。 





图 5-8 对 极 几何 示意 图 


其 中 11 和 12 为 两 帧 图 像 ，P 为 三 维 空间 中 的 点 ，p1 和 pz 为 P 点 在 两 图 像 上 的 投影 ，O1 和 O2、11 和 |l2、e1 和 e2 分 别 为 相机 ;ye 心 、 极 线 和 极点 。 


设 P= (X，Y，Z) “， 以 第 一 个 图 像 为 参考 系 ， 根 据 小 孔 成 像 的 相机 模型 可 得 到 投影 方程 为 : 
diPp1=KP (5-31) 


d2p2=K (RP+t) (5-32) 


其 中 K 为 相机 的 内 参 ， 由 相机 本 身 决 定 ，d 为 空间 的 深度 信息 ，R 和 t 是 图 像 2 相 对 于 图 像 1 的 旋转 和 平移 矩阵 ， 也 正 是 需要 求解 的 。 


为 了 去 掉 相 机 内 参 ， 使 用 归 一 化 的 坐标 ， 记 : x1=K- 1p1，x2=K- 1p2。 将 x1 和 x2 代 入 式 (5-31) 和 式 (5-32) 推导 与 化 简 得 到 对 极 几何 的 约束 条 
件 : 


vt x Rx, = x,Ex, = 0 (5-33) 


其 中 E=txR 称 为 本 质 和 矩阵 。 该 约束 刻画 了 相机 的 光 心 和 P 点 共 面 的 天 系 。 


根据 约束 式 的 关系 和 2D-2D 的 匹配 点 的 对 应 关系 可 以 计算 得 到 本 质 矩 阵 E， 再 通过 E 进 行 分 解 得 到 R 和 t， 从 而 估计 相机 的 运动 。 常 见 的 求 本 质 和 矩阵 E 有 
五 点 法 和 八 点 法 ， 其 中 五 点 法 可 以 使 用 五 对 特征 点 来 计算 R 和 t， 但 是 其 需要 利用 本 质 矩 阵 的 非 线性 性 质 ， 如 Nister 在 论文 上“?] 就 提出 了 一 种 五 点 法 的 计算 
方法 。 而 八 点 法 是 将 E 看 作 3x 3 的 矩阵 ， 在 去 掉 尺 度 因子 之 后 剩 8 个 自由 度 ， 利 用 8 对 点 即 可 以 求解 本 质 和 矩阵 。 当 多 余 8 对 特征 点 时 ， 此 时 可 以 用 最 小 二 乘 解 
来 代替 或 者 使 用 RANSAC 算 法 来 进行 求解 。 在 得 到 相机 运动 的 R 和 t 之 后 根据 三 角 化 算得 特征 点 的 3D 坐 标 ， 然 后 利用 3D-2D 的 PnP 算法 进行 后 续 相 机 姿态 的 
估计 ， 故 一 般 对 极 几 何 的 方法 一 般 用 于 单 目 视觉 里 程 计 的 初始 化 。 


5.3.3 “PnP 算法 原理 简介 [7] 


PnP 算 法 是 以 3D 扣 空 间 位 置 与 相机 上 的 投影 点 来 求解 相机 旋转 矩阵 R 和 平移 算 阵 t 的 算法 。 一 般 有 代数 解法 和 优化 解法 。 代 数 解 法 包括 DLT (直接 线性 
变换 ) 、P3P、EPnP 等 算法 。 优 化 解法 主要 是 Bundle Adjustment (BA) 算法 ， 该 算法 是 一 种 优化 的 解法 ， 以 重 投 影 误差 为 优化 目标 来 求解 相机 的 位 


在 图 5-9 中 ， 以 图 像 1 为 参考 系 ， 图 像 2 中 的 投影 关系 为 : 


d2p2=Kexp (EN) P (5-34) 





图 中 P 为 坐标 已 知 的 3D 点 ，expP (&^) 为 由 图 像 1 变换 到 图 像 2 的 相机 旋转 和 平移 矩阵 的 李 代数 表示 形式 ， p ”是 通过 运动 变换 在 图 像 上 对 应 的 像素 坐 
标点 可 由 式 (5-33) 右边 得 到 ，p2 为 实际 观测 到 的 像素 坐标 可 由 陈 (5-32) 得 到 ， 实 际 中 由 于 误差 的 人 存在， 等 式 两 边 并 不 相等 ， 它 们 之 间 的 误差 称 为 重 投 


影 误差 即 : 


Cc; 二 PP; Kexp(é/ )P, 人 
OU; 


上 陈 表 示 了 单个 点 所 具有 的 重 投影 误差 ， 将 所 有 的 重 投影 误差 加 起 来 瓯 是 整个 图 像 的 重 投影 误差 ， 在 具体 的 算法 当中 及 用 每 个 点 重 投影 二 学 数 的 平方 
和 作为 整体 误差 ， 即 优化 函数 关系 为 : 


nt 


0 
本 = argmin 本 之 


I 二] 


Li | 


p; 一 Kexp(é )P. | (5-36) 





Oe 
在 优化 过 程 中 往往 将 目标 沿 着 导数 方向 去 优化 可 以 快速 获得 最 佳 的 效果 ， 因 此 在 算法 中 还 会 给 出 重 投影 误差 与 误差 变化 的 导数 关系 即 90*。 


5.3.4 ”直接 ; 


在 实际 应 用 当中 ， 特 征 点 的 提取 和 描述 子 的 计算 非常 耗 时 ， 因 此 也 提出 了 一 些 其 他 的 方法 ， 比 如 光 流 法 (Optical Flow) 和 直接 法 。 光 流 法 通过 估计 
像素 在 不 同时 刻 图 像 中 的 运动 来 完成 特征 点 的 跟 中 ， 从 而 实现 特征 点 的 匹配 ， 这 样 束 省 去 了 描述 子 的 计算 和 匹配 的 时 间 。 光 流 只 反映 了 像素 间 的 平 黎 ， 并 
没有 涉及 相机 本 身 的 几何 结构 ， 也 没有 考虑 到 相机 的 旋转 和 图 像 的 缩放 。 而 直接 法 考虑 到 了 这 些 信息 ， 其 也 是 基于 灰 度 不 变 的 理论 假设 ， 直 接 利用 两 帧 图 
像 的 投影 天 系 建 立 灰 度 误差 关系 。 直 接 法 根据 使 用 图 像 像素 的 多 少 ， 又 可 分 为 稀 中 、 半 稠密 和 稠密 三 种 方法 。 直 接 法 的 基本 原理 如 图 ?-11 所 示 。 





图 5-10 ”直接 法 投影 示意 图 
P 为 三 维 空间 中 的 点 ，p1 和 pz 为 P 在 两 帧 图 像 上 的 投影 ， 以 第 1 帧 为 参考 系 ， 它 们 的 投影 天 系 为 : 


Di = KP (S$-37) 
CI 


1 1 ee z 
p, = —K(RP +1t) = —Kexp(é’ )P (95-38 ) 
人 d, 
根据 灰 度 不 变 理论 假设 ， 两 者 的 测量 误差 为 : 
e=11 (pl1) 一 I2 (p2) (5-39) 


这 是 一 个 点 的 灰 度 测 量 误 兰 。 整 个 问题 融 变 成 求解 最 优 的 5 使 得 n 个 像素 点 所 对 应 的 误差 最 小 ， 优 化 目标 函数 为 : 
nn 
min/(é) = eie, (35-40) 
二 |] 


通过 不 断 的 优化 迭代 求解 从 而 得 到 最 优 的 &。 在 优化 的 过 程 中 ， 图 像 梯度 引导 着 优化 的 方向 ， 应 尽量 利用 图 像 梯 度 明 显 的 像素 点 。 另 外 为 了 得 到 全 局 的 
最 优 解 ， 融 必须 保证 从 切 始 值 到 最 优 估计 这 个 过 程 中 梯度 一 直下 降 ， 因 此 这 种 方法 很 容易 受到 图 像 非 止 性 的 影响 而 得 到 局 部 最 优 解 。 


5.3.5 ”本 节 小 结 


视 周 里程 计 主 要 是 依靠 图 像 来 估计 相机 的 运动 ， 直 接 法 和 特征 点 法 都 是 比较 重要 的 万 法 。 其 中 特征 点 法 友 展 较为 成 熟 ， 能 够 在 噪声 较 大 、 运 动 较 快 的 
时 候 工作 ， 主 要 是 特征 点 的 提取 和 匹配 会 消耗 大 量 的 时 间 。 而 直接 法 能 够 省 略 特 征 提取 的 时 间 ， 在 特征 点 少 的 环境 下 仍 能 继续 正常 工作 。 不 过 其 基于 灰 度 
不 变 理论 的 假设 在 实际 中 由 于 高 光 、 阴 影 和 材质 等 的 影响 ， 很 有 可 能 不 成 了 ， 另 外 还 受到 图 像 非 凸 性 的 影响 。 
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第 6 章 ”智能 汽车 试验 验证 技术 


目 动 驾驶 融合 多 项 新 兴 技 术 ， 已 经 成 为 当前 全 球 汽车 产业 技术 竞争 的 焦点 和 制 高 上 尽 ， 智 能 汽车 及 其 相关 智能 技术 的 研究 不 仪 成 为 当前 信息 技术 、 传 感 
器 技术 和 认 知 科学 相 结合 的 友 展 引 敬 ， 而 且 可 应 用 于 未 来 智慧 交通 及 智慧 城市 以 减少 道路 交通 事故 率 和 伤亡 率 ， 提 高 交通 效率 和 雪 乘 体验 ， 同 时 促进 和 市 
动 汽 于 产业 友 展 和 变 半 创新 ， 并 可 为 国防 安全 领域 相 天 研究 与 应 用 提供 关键 技术 文 撑 。 


近 几 年 来 ， 谷 歌 、 百 度 等 互联 网 科技 公司 都 推出 了 上 自己 的 无 人 驾驶 和 车辆， 福特 、 沃 尔 湛 等 众多 国内 外 汽车 制造 厂家 也 都 尝试 在 2021 年 前 后 将 其 自动 各 
驶 车 辆 投放 市 场 ， 国 内 上 汽 、 户 来 等 传统 和 新 兴 汽 车 企业 也 已 经 研制 出 了 自己 的 自动 驾驶 车 辆 ， 并 已 经 在 美国 开始 测试 。 


目 动 驾驶 车 辆 的 商业 化 应 用 的 前 提 是 必须 具备 足够 高 的 安全 性 ， 且 不 会 干扰 正常 的 交通 秩序 ， 但 如 何 对 自动 驾驶 车 辆 的 安全 性 和 交通 依从 性 进行 验 
证 ， 目 前 还 缺乏 系统 有 效 的 方法 ， 目 动 驾驶 千 辆 的 测试 评价 技术 已 成 为 当前 全 世界 研究 的 热点 。 


6.1 智能 污 后 试验 验证 面 | 





甸 的 挑战 


如 第 1 章 所 述 ， 智 能 汽车 可 分 为 0 ~ 5 级 ， 其 中 0 ~ 2 级 驾驶 员 还 在 环 ， 智 能 汽车 是 辅助 驾驶 员 更 好 地 和 驾驶， 驾驶 员 是 驾驶 的 主体 ， 这 部 分 功能 属于 先进 
驾驶 辅助 系统 (ADAS) 的 范畴 。ADAS 是 当前 智能 网 联 汽车 产业 化 的 重要 领域 ， 技 术 发 展 也 已 经 较为 成 就 ， 当 前 针对 ADAS 的 测试 评价 方法 已 经 较 多 ,， 音 
分 已 经 形成 了 标准 ， 比 如 和 目 适应 巡航 控制 系统 (ACC) 、 目 动 紧急 制 动 系统 (AEB) 等 。 


随 看 传 感 、 通 信 、 决 策 、 控 制 等 扩 术 的 快速 友 展 ， 当 前 智能 汽车 正 逐 步 由 钨 驶 辅助 向 有 条 件 上 自动 轰 驶 、 高 度 目 动荡 驶 乃至 无 人 苞 驶 的 方向 友 展 ， 这 种 
技术 升级 给 智能 汽车 的 测试 评价 市 来 了 新 的 挑战 。 在 第 3 级 的 智能 汽车 中 ， 和 驾驶 员 在 某 些 工 况 下 可 以 完全 不 在 环 ， 和 驾驶 任务 完全 由 车辆 独立 完成 ， 但 需要 各 
驶 员 在 必要 的 时 候 接 管 车 辆 的 控制 权 。 这 种 驾驶 员 从 驾驶 任务 环 中 的 脱离 ， 即 使 是 在 很 普通 的 工 况 下 (比如 和 车道 保持 、 跟 车 等 ) 脱离 短暂 的 时 间 ， 也 意味 

驾驶 主体 从 人 变 成 了 车 辆 ， 从 技术 上 看 起 来 似乎 只 是 友 展 一 小 步 ， 但 是 仔细 分 析 ， 这 一 步 市 来 了 很 多 新 的 变化 。 


在 第 3 级 的 智能 汽车 中 ， 当 和 车辆 处 于 目 动 驾驶 模式 但 友 现 驾驶 环境 不 适宜 上 自动 驾驶 时 ， 和 车辆 通过 人 机 交互 界面 (HMI1) 向 驾驶 员 友 出 信息 提示 ， 要 求 驾 
驶 员 接 管 车 辆 的 控制 权 ， 这 种 情况 通常 需要 驾驶 员 在 较 短 的 时 间 内 回 到 和 车辆 的 控制 环 中 。 但 由 于 驾驶 员 不 在 环 (比如 在 看 电影 、 打 游戏 等 ) ， 反 映 时 间 必 
然 会 比 和 驾驶 员 驾 驶 时 的 反应 时 间 要 长 。 相 当 多 的 研究 友 现 ， 在 这 种 情况 下 驾驶 员 人 至 少 需 要 7 ~ 10s 的 反应 时 间 才 能 回 到 车辆 的 控制 中 ， 一 些 研究 甚至 友 现 ， 
从 驾驶 员 接收 到 要 求 接 管 车 辆 控制 的 信号 到 真正 实现 车 辆 的 稳定 操控 需要 不 少 于 40 秒 的 时 间 ， 而 雪 驶 员 笃 驶 时 的 反应 时 间 通 单 在 0.6 ~ 2s 的 范围 内 。 这 意味 
着 在 自动 驾驶 模式 中 ， 和 车 辆 必须 在 驾驶 员 能 够 接管 车 辆 控制 前 自己 处 理 当 前 环境 中 任何 复杂 的 交通 工 况 或 案 急 事件 。 换 句 话说 ,第 3 级 及 以 上 的 上 自动 驾驶 测 
试 意味 着 必须 要 证 明和 车 辆 能 够 以 安全 的 方式 处 理 设 定 运 行 环境 中 的 任何 突 友 交通 工 况 ， 驾 驶 功能 的 完备 性 成 为 必须 要 考虑 的 方面 ， 由 于 和 车辆 是 否 安 全 与 人 
的 生命 财产 高 度 相关 ，99% 的 可 靠 性 是 远 远 不 够 的 。 


因此 ，ADAS 系 统 的 测试 评价 需要 从 技术 、 用 尸 相关 、 安 全 收 葵 三 个 层面 去 验证 系统 功能 及 性 能 满足 设计 要 求 ， 而 目 动 驾驶 首先 必须 证 明 其 比 当前 人 
类 驾驶 更 为 安全 ， 人 至 少 也 是 同等 安全 ， 不 会 增加 交通 事故 或 加 重 交通 事故 伤害 ， 因 此 交通 事故 率 或 伤亡 率 构成 了 一 个 参考 标准 。 


由 于 交通 事故 是 一 个 小 概率 事件 ， 比 如 美国 道路 交通 中 发 生 一 起 人 员 死 亡 的 事故 概率 是 1.09x10 - 2/km， 而 德国 高 速 公路 发 生 一 起 人 员 死 亡 的 事故 概 
率 是 1.52x10 -3/km， 因 此 如 果 要 从 统计 学 意义 上 显著 地 证 明 自 动 驾 驶 的 安全 性 将 会 导致 很 大 甚至 不 可 能 实现 的 测试 工作 量 。 比 如 达 姆 斯 塔 特大 学 的 研究 
人 员 人 研究 友 现 ， 在 德国 如 果 要 证 明 目 动 驾驶 比 人 为 驾驶 安全 ， 人 至 少 需 要 1 亿 干 米 的 实际 道路 测试 。 而 美国 兰 德 公司 更 是 发 现 ， 在 95% 的 置信 和 度 水 平 下 ， 如 果 
要 证 明 自 动 驾驶 车 辆 导致 的 交通 事故 死亡 率 比 人 为 驾驶 低 ， 需 要 50 亿 英里 [的 实际 道路 测试 ( 见 图 6-1) ， 换 算 一 下 ， 假 设 测试 车 辆 实际 道路 测试 时 的 平 
均 竺 速 为 40km/h， 测 试车 队 由 100 辆 车 构成 ， 全 年 365 天 ， 每 天 24 小 时 无 间断 运行 ， 跑 完 这 个 里 程 需 要 化 费 大 概 230 年 ，“ 里 程 置 梦 ” 是 限制 目 动 区 驶 规 


模 化 商业 应 用 的 一 大 阻碍 。 
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图 6-1 证 明 自 动 驾 驶 安全 性 需要 的 实际 道路 测试 里 程 数 


与 之 相对 应 的 是 ， 作 为 当前 无 人 驾驶 技术 的 引领 者 ， 谷 歌 广 泛 采 用 实际 道路 测试 ， 从 2009 年 到 2015 年 ， 实 际 目 动 各 驶 模式 测试 距离 疯 不 超过 200 万 英 
里 ， 远 不 能 证 明 其 自动 驾驶 车 辆 比 人 类 驾驶 更 为 安全 。 


因此 ， 面 对 当前 智能 汽车 研发 快速 迭代 的 需求 ， 有 必要 研究 更 为 高 效 的 测试 评价 方法 ， 能 够 实现 自动 加 驶 /无 人 驾驶 车 辆 的 “加 速 ” 评 价 。 当 前 在 该 领 
域 国内 外 尚 没有 提出 系统 的 测试 评价 万 法 ,但 从 已 有 的 ADAS 测 试 评价 万 法 进行 引申 ,我们 可 以 探讨 高 级 自动 驾驶 /无 人 各 驶 的 测试 评价 方法 。 


[1] 1 英里 =1.609 千 米 。 


6.2 ” 千 能 污 后 试验 验证 扩 林 的 介绍 


6.2.1 智 论 气 车 测试 验证 机 理 


驾驶 是 人 -车 -路 三 者 构成 的 闭环 控制 系统 ， 如 图 6-2 所 示 ， 涉 及 不 同 层级 的 驾驶 环境 和 驾驶 任务 之 间 的 多 维度 交互 。 从 宏观 到 微观 的 角度 ， 驾 驶 环境 包 
括 路 网 、 路 段 和 路 面 三 个 层次 ;对 应 的 驾驶 任务 也 存在 三 个 不 同 的 层次 ， 导 航 层 针对 路 网 ， 对 整个 各 驶 过 程 进 行规 划 ， 确 定 到 达 目 的 地 的 路 线 ， 估 计 行 程 
时 间 等 ;指引 层 主要 是 根据 实际 驾驶 路 段 的 交通 场景 规划 驾驶 动作 ， 以 完成 导航 层 设 定 的 驾驶 任务 ， 比 如 根据 交通 流 的 变化 选择 车 道 、 设 定期 望 行驶 速度 
等 ; 稳定 层 是 指 完 成 指引 层 规划 的 驾驶 动作 所 需 的 具体 驾驶 行为 ， 比 如 转动 方向 盘 进 行 变 道 、 躁 制 动 踏板 减速 等 。 
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可 替代 路 径 
图 6-2 ”驾驶 机 理 


传统 的 汽车 测试 通 剃 只 考虑 车 辆 在 特定 输入 下 的 相应 ， 如 图 6-2 中 的 灰色 部 分 所 示 ， 考 核 的 主要 是 车 辆 和 路 面 之 间 的 交互 ， 不 涉及 驾驶 员 和 环境 之 间 的 
交互 。 目 动 驾驶 是 用 机 器 控制 部 分 或 全 部 取代 了 各 驶 员 的 角色 ， 因 此 对 目 动 各 驶 车 辆 的 测试 和 考核 必须 考虑 驾驶 员 、 车 辆 和 道路 环境 之 间 的 整个 交互 环 
节 ， 所 需 考 虑 的 范围 远 远 超出 了 传统 汽车 测试 的 范畴 ， 图 6-2 中 的 白色 部 分 即 为 自动 驾驶 测试 所 需要 增加 的 内 容 。 


因此 ， 对 于 自动 驾驶 车 辆 的 测试 评价 ，“ 场 景 ” 或 者 “人 态势 ”扮演 着 举足轻重 的 地 位 ， 自 劫 驾驶 车 辆 的 测试 需要 考核 车 辆 在 不 同 的 场景 或 态势 下 的 感 
知 、 决 策 、 控 制 执行 与 不 同 维度 的 场景 或 态势 要 素 之 间 的 相互 作用 。 


另外 ， 对 于 2 级 及 以 下 的 自动 驾驶 和 车辆， 也 束 是 通常 意义 的 先进 各 驶 辅助 系统 (ADAS) 而 言 ， 由 于 雪 驶 员 是 加 驶 的 主体 ， 和 车 辆 只 是 在 特定 的 场景 下 帮 
助 驾 驶 员 完 成 特定 的 驾驶 任务 ， 因 此 对 ADAS 测 评 而 言 ， 场 景 的 “典型 性 ”是 核心 ， 即 考核 车 辆 在 典型 场景 下 的 应 对 能 力 ， 其 他 场景 仍然 由 驾驶 员 负 责 完 
成 。 


对 于 3 级 及 以 上 的 上 自动 各 驶 车 辆 ， 即 高 等 级 的 目 动 驾驶 ， 驾 驶 员 不 再 时 刻 监 督 驾 驶 任务 ， 因 此 车 辆 需要 处 理 在 设计 行驶 区 域 (Operational Design 
Domain，ODD) 里 面 所 有 的 驾驶 任务 。 对 于 高 等 级 自动 驾驶 而 言 ， 场 景 的 “完备 性 ”是 核心 ， 即 考核 车 辆 在 所 有 可 能 场景 下 的 感知 、 决 策 和 控制 行为 。 


6.2.2 ”ADAS 测 试 评价 方法 


先进 驾驶 辅助 系统 可 以 被 认为 是 低 等 级 的 目 动 驾 驶 车 辆 。ADAS 友 展 较 早 ， 当 前 诸如 AEB 系 统 、LKA 等 部 分 技术 已 经 较为 成 熟 ， 产 品 也 正 处 于 快 步 迈 向 
产业 化 的 进程 中 。ADAS 的 测评 方法 已 经 得 到 了 元 分 的 研究 ， 其 中 最 为 系统 的 是 欧盟 的 PreVENT 项 目 ， 该 项 目 建 六 了 ADAS 系 统 综 合 测 评 框 染 ， 包 括 技术 、 
用 尸 相 关 和 收益 三 个 测评 层面 。 该 框架 将 ADAS 的 测试 分 为 以 下 六 步 : 


第 0 步 ， 系 统 和 功能 摘 述 (在 设计 阶段 就 已 经 完成 ) 。 
第 1 步 ， 预 期 收益 和 假设 。 

第 2 步 ， 测 试 场景 定义 。 

第 3 步 ， 评 价 方 法 选择 。 

第 4 步 ， 制 定 测量 计划 。 

第 5 步 ， 执 行 测试 和 分 析 。 


1.ADAS 测 试 工具 及 方法 


由 于 驾驶 是 一 个 由 驾驶 员 、 车 辆 和 道路 环境 构成 的 人 -车 -路 闭环 控制 系统 ， 按 照 人 、 和 车 、 路 三 者 不 同 的 表现 形式 ， 可 将 ADAS 的 测试 评价 方法 思 体 上 分 


为 如 图 6-3 所 示 的 仿真 测试 、 驾 驶 模拟 器 测试 、 受 控 场 地 测试 、 实 证 测试 (Field Operational Tests，FOT) 四 大 类 。 在 这 四 类 万 法 中 ， 人 、 车 、 路 三 者 可 
以 是 真实 的 ， 也 可 以 是 虚拟 /模拟 的 。 通 常 评价 结果 的 有 效 性 随 着 真实 元 素 的 增多 而 提高 ， 最 高 层次 的 评价 方法 是 FOT， 在 FOT 中 ， 真 实 驾 驶 员 在 真实 道路 


中 与 真实 的 车 辆 产生 交互 ， 人 、 和 车 、 路 三 者 都 是 真实 的 ， 评 价 的 结果 也 是 最 为 准确 的 ， 但 也 是 成 本 最 高 、 耗 时 最 长 的 ， 在 受 控 场地 测试 中 ， 真 实 的 驾驶 员 
具 虚 拟 


驾驶 真实 的 车 辆 ， 但 是 交通 环境 是 模拟 (人造 ) 的 测试 环境 ;采用 驾驶 模拟 器 上 时， 驾驶 员 处 于 等 驶 模拟 舱 中 ， 车 辆 的 特性 和 交通 环境 是 通过 仿真 工 
I; 在 仿真 测试 中 ， 人 、 车 、 路 三 个 元 素 都 采用 虚拟 的 数学 模型 代替 。 
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图 6-3 ”测试 评价 方法 分 类 


改善 这 些 薄 弱 环 节 ， 可 以 提出 抽 销 的 ADAS 技 术 概 念 模型 ,包含 系统 功能 需求 和 技术 指标 。 在 概念 设计 阶段 ，ADAS 的 概念 模型 可 以 通过 数学 模型 进行 建 
模 ， 然 后 通过 仿真 测试 进行 测评 验证 。 仿 真 测试 包含 模型 在 环 (Model-in-the-loop，MIL) 仿真 、 软 件 在 环 (Software-in-the-loop，SIL) 仿真 以 及 硬 
件 在 环 (Hardware-in-the-loop，HIL) 仿真 三 种 ， 相 关 测 试 原理 已 经 在 第 二 章 中 进行 过 前 述 。 最 早 的 ADAs 系 统 概念 可 通过 MI 儿 仿 真 进行 评价 ， 将 车 辆 动 
力学 模型 、 传 感 器 模型 、 驾 驶 员 模 型 和 交通 环境 模型 集成 起 来 ， 通 过 仿真 测试 优化 系统 算法 和 控制 参数 ， 使 得 满足 期 望 的 功能 需求 和 性 能 指标。 类 似 于 
PreScan、ProSivic 等 软件 具有 丰富 的 场景 库 和 传感器 模型 库 ， 能 够 快速 构建 复杂 的 交通 环境 ， 为 MIL 仿 真 提供 了 良好 的 仿真 环境 ( 见 图 6-4) 。 














图 6-4 ”PreScan 模 型 在 环 仿 真 测试 


通过 MI1L 仿 真 获得 了 足够 满意 的 评价 结果 后 ， 可 以 对 ADAS 系 统 的 控制 模型 进行 软件 代码 编译 。 真 实 的 软件 代码 可 以 通过 软件 在 环 (SIL) 仿真 进行 验 
其 


证 ， 其 余 的 硬件 、 车 辆 动力 学 模型 以 及 交通 环境 通过 实时 仿真 引入 控制 循环 。 


与 Sl 仿真 类 似 ， 实 际 的 硬件 可 以 通过 硬件 在 环 (HIL) 进行 实时 仿真 测试 。HIL 由 真实 部 件 和 仿真 部 件 构成 ， 真 实 部 件 也 可 以 用 具有 相同 输入 和 输出 特 
性 的 人 造 部 件 代 蔡 。 HI 仿真 的 测试 柔性 、 重 复 性 好 ， 能 够 安全 、 灵 活 且 可 靠 的 进行 测 坛 ， 不 受 无 天 系统 的 干扰 ， 测 试 效 率 高 ， 成 本 较 低 ， 同 时 由 于 采用 真 
实 部 件 ， 提 高 了 结果 的 可 靠 性 。 HIL 仿 真 在 ADA3s 技 术 开 发 的 早期 阶段 允许 对 实际 的 硬件 进行 测试 ， 不 需要 样 车 ， 因 为 所 有 缺失 的 车 辆 部 件 都 可 以 用 仿真 模 
型 代 蔡 。 这 种 方法 目前 已 经 广泛 用 于 ADAS 系 统 控制 策略 、 环 境 感知 算法 、 多 传感器 信息 融合 算法 的 开发 和 验证 中 。 


由 于 仿真 测试 只 能 提供 技术 有 效 性 的 评价 结果 ， 无 法 评价 用 户 相关 层面 的 性 能 ， 比 如 用 户主 观 接受 度 、 可 用 性 、 可 控 性 等 ， 而 这 些 性 能 对 ADAS 系 统 
来 说 非常 关键。 因此， 将 仿真 测试 中 的 驾驶 员 模 型 用 能 够 代表 普通 大 众 的 真实 驾驶 员 代 蔡 ， 在 开发 的 早期 阶段 ， 这 可 以 通过 驾驶 模拟 器 实现 。 图 6-5 是 同济 
大 学 的 动态 驾驶 模拟 器 ， 由 模拟 器 舱 和 八 上 自由 度 驱 动机 构 构 成 。 模 拟 器 舱 通 过 虚拟 交通 场景 和 真 车 驾驶 舱 营 造 出 沉浸 式 竹 驶 环境 ， 驱 动机 构 的 运动 则 构造 
出 对 应 于 当前 虚拟 雪 驶 环境 委 驶 员 操 作 的 车 辆 姿态 运动 。 
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图 6-5 同济 大 学 的 八 自 由 度 驾驶 模拟 器 


驾驶 模拟 器 测试 最 大 的 优点 是 测试 可 重复 性 好 ， 且 高 度 危 险 的 场景 可 以 高 效 、 无 危险 地 复 现 。 但 通过 人 为 模拟 的 车 辆 动力 学 特性 毕竟 与 真实 的 车 辆 运 
动 仓 在 差异 ， 给 驾驶 员 的 运动 感 不 够 真实 ， 因 此 通常 情况 下 不 足以 评价 与 车 辆 动力 学 特性 高 度 相 关 的 ADAS 系 统 。 同 时 ， 为 了 获得 具有 统计 显著 性 的 结 
果 ， 针 对 一 个 性 能 指标 的 评价 通常 也 需要 多 名 驾驶 员 进行 测 试 ， 因 此 能 够 分 析 的 场景 数量 有 限 。 另 外 ， 昌 然 没 有 危险 是 驾驶 模拟 器 测试 的 一 大 优点 ， 但 也 
是 一 大 缺点 ， 因 为 在 没有 发 生 事故 伤害 的 顾虑 时 驾驶 员 的 行为 可 能 会 友 生 变化 。 


在 驾驶 模拟 器 中 车辆 的 动力 学 特征 只 能 有 限 程度 的 描述 ， 受 控 场 地 测试 用 真实 的 车 辆 代替 了 人 造 的 动力 学 环境 ， 因 此 受 控 场地 测试 是 获得 ADAS 系 统 
有 效 性 更 为 可 靠 的 方法 。 但 另外 ， 受 控 场 地 测试 所 需 的 前 提 条 件 很 高 ， 系 统 的 功能 必须 集成 在 合适 的 测试 样 车 上 ， 交 通 环 境 需 要 通过 合适 的 方式 进行 复 
现 ， 要 有 足够 空间 的 试车 场 以 保证 所 有 测试 相关 人 员 的 安全 性 。 图 6-6 是 自动 紧急 制 动 系统 的 场地 测试 ， 用 来 评价 AEB 系 统 的 避 拉 效能， 为 了 防止 友 生 碰撞 
对 试验 人 员 和 测试 车 辆 造成 破坏 ， 测 试车 辆 前 万 目标 车 采用 气球 车 代 蔡 。 





图 6-6” 受 控 场 地 测试 


受 控 场地 测试 能 够 快速 、 准 确 、 可 重复 地 评价 ADAS 系 统 的 性 能 ， 且 不 需要 了 解 ADAS 系 统 的 内 部 构成 和 控制 策略 ， 因 此 ADAS 系 统 的 测试 标准 和 规范 
也 主要 针对 受 控 场地 测试 。 目 前 ,一 些 ADAS 系 统 的 受 控 场地 测试 方法 已 经 成 为 标准 或 规范 ， 比 如 ISO15622、1SO22179 定 义 了 ACC 和 全 速 ACC 系 统 的 测 
试 流程 ，Euro-NCAP 在 2014 年 上 发布 了 AEB 城 市 系统 (AEB City) 和 AEB 高 速 系统 (AEB Inter-urban) 系统 的 测试 评价 方法 ， 而 在 2016 年 发 布 了 AEB 行 人 
(AEB Pedestrian) 的 测试 评价 方法 。 我 国 的 C-NCAP 也 将 在 2018 年 引入 对 AEB 系 统 的 测评 。 


ADAs 系 统 的 受 控 场地 测试 需要 复 现 典型 的 交通 危险 场景 ， 场 景 布置 可 能 涉及 不 同道 路 形态 、 不 同 的 车 道 线 型 、 不 同 的 交通 标志 、 不 同 的 交通 参与 者 
(如 车 辆 、 行 人 、 骑 车 人 ) 等 要 求 ， 因 此 需要 专用 的 试车 场 。 当 前 像 ACC、AEB 这 类 ADASs 系 统 的 测试 场景 相对 简单 ， 还 可 以 在 传统 的 试验 场 中 进行 。 未 
来 ， 随 着 ADAs 系 统 的 功能 升级 、 自 动 委 驶 /无 人 驾驶 的 技术 发 展 ， 进 行 受 控 场地 测试 所 需要 复 现 的 交通 场景 也 会 越 来 越 多 且 越 来 越 复 杂 ， 传 统 的 试验 场 已 
经 不 能 满足 智能 网 联 汽车 功能 开发 和 验证 的 需要 ， 当 前 全 世界 都 在 建设 智能 网 联 汽车 专用 试验 场 ， 这 部 分 内 容 将 在 后 面 的 章节 中 介绍 。 


最 终 ， 所 有 的 ADAS 功 能 都 应 该 在 公共 道路 上 进行 测试 评价 ， 因 为 真实 交通 环境 中 存在 的 危险 工 况 是 无 穷 无 尽 的 ， 而 在 驾驶 模拟 器 和 受 控 场地 测试 中 
只 能 模拟 相当 小 的 一 部 分 。 所 以 ADAS 系 统 的 最 终 评 价 是 通过 实证 测试 (FOT) 研究 系统 在 真实 交通 工 况 下 的 短期 和 长 期 表现 来 完成 的 。 在 进行 FOT 测 试 
时 ， 需 要 在 车 辆 上 安装 各 种 传感器 及 数据 采集 设备 ， 比 如 摄像 头 、GPS 等 ( 见 图 6-7) ， 对 和 车辆 行驶 过 程 中 的 驾驶 环境 、 驾 驶 员 行 为 、 车 辆 状态 参数 进行 全 
方位 的 采集 ， 这 些 设备 通过 恰当 的 方式 安 六 并 适当 隐藏， 使 得 驾驶 员 通 常情 况 下 难以 注意 到 他 正在 被 观察 ， 以 使 得 驾驶 员 的 驾驶 行为 更 接近 真实 状态 的 驾 
驶 行为 ， 驾 驶 状态 为 真实 的 正常 驾驶 状态 。FOT 测 试 是 一 种 准 试验 测试 方法 ， 需 要 设置 实验 组 和 对 比 组 ， 一 般配 备 有 ADAS 系 统 的 测试 组 定义 为 实验 组 ， 示 
配备 相关 系统 的 测试 组 定义 为 对 比 组， 最终 通 过 对 比 两 组 的 驾驶 数据 ， 比 如 发 生 事 故 数 、 平 均 THW (Time Headway， 定 义 为 两 车 相对 距离 除 以 后 车 速 
度 ， 相 当 于 时 距 ) 等 参数 来 评价 ADAS 系 统 的 性 能 。 
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图 6-7 ”FOT 数 据 和 采集 


由 于 实际 驾驶 中 危险 工 况 出 现 的 概率 非常 小 ， 通 常 一 辆 车 不 足以 进行 FOT 测 试 ， 而 需要 大 量 的 车 辆 才能 获得 有 统计 意义 的 结果 ， 因 此 FOT 测 试 的 数据 
量 将 会 非常 大 。 为 了 处 理 大 量 的 数据 ， 必 须 建立 合适 的 数据 处 理 结构 ， 使 得 FOT 的 数据 获取 、 管 理 、 处 理 和 数据 分 析 过 程 自动 化 ， 以 保证 快速 完备 的 系统 
评价 。 图 6-8 为 Euro-FOT 的 数据 处 理 过 程 ，Euro-FOT 关 注 的 重点 是 对 ACC 和 前 方 磁 撞 预 和 警 (Forward Collision Warning，FCW) 系统 的 评价 。 


仿真 测 坛 、 驾 驶 模拟 器 测试 、 受 控 场 地 测试 和 实证 测试 可 如 前 所 述 ， 通 过 人 、 和 车、 路 三 者 之 间 的 表现 形式 从 逻辑 上 联系 起 来 。 从 系统 开 皮 的 角度 出 
上 发， 仿真 测试 和 驾驶 模拟 器 测试 应 当 在 开发 的 早期 阶段 进行 ( 见 图 6-10) ， 特 别 是 轰 驶 模拟 器 测试 。 一 个 重要 的 原因 是 通过 驾驶 模拟 器 测试 能 够 得 到 系统 
可 控 性 和 功能 安全 性 指标 的 量化 输入 ， 任 何不 能 被 驾驶 员 控制 的 系统 失效 ， 都 应 当 通 过 功能 安全 处 理 ， 比 如 通过 执行 器 宛 余 等 方法 。 
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图 6-8 ”Euro、FOT 的 数据 处 理 过 程 


仿真 测试 








图 6-9 ”各 种 测试 方法 在 系统 开发 中 的 位 置 


同样 ， 受 控 场 地 测试 也 能 够 为 系统 性 能 指标 提供 有 价值 的 参考 输入 ， 因 此 应 当 尽量 在 开 友 的 早期 阶段 进行 。ADAs 系 统 开 上 友 定 型 后 ， 通 过 FOT 进 行 最 终 
的 验证 和 评价 。 


为 提高 开发 效率 ，V 模 式 开 发 方法 在 ADAS 的 开发 中 得 到 了 广泛 的 应 用 ， 在 V 模 式 开发 过 程 中 的 不 同 阶段 (概念 设计 、 开 发 、 验 证 ) ， 仿 真 测试 、 驾 驶 
模拟 器 测试 、 受 控 场 地 测试 和 实证 测试 分 别 融 入 系统 开 友 的 相应 阶段 中 ( 见 图 6-9) 。 


在 ADAS 系 统 的 开发 过 程 中 ， 必 须 提出 确切 可 靠 的 评价 指标 ， 才 能 确定 系统 功能 是 否 安全 及 最 终 的 验证 是 否 可 靠 。 但 除了 少量 形成 标准 的 测试 方法 
外 ， 评 价 指标 的 确定 目前 还 没有 统一 的 方法 ， 尤 其 是 用 户 相关 层面 的 评价 ， 驾 驶 员 对 系统 的 可 控 性 和 有 效 性 的 主观 认识 以 及 驾驶 员 的 主观 接受 度 的 边界 值 
目前 还 难以 准确 得 到 。 因 此 ， 未 来 还 需要 对 驾驶 员 行 为 进行 深入 研究 ， 这 可 以 从 自然 驾驶 数据 研究 (Naturalistic Driving Study，NDS) 或 FOT 测 试 得 到 
的 数据 库 中 进行 深入 的 挖掘 。 


2.ADAS 测 试 场景 定义 


场景 是 ADAS 开 发 和 测评 的 关键 因素 ， 是 ADAS 系 统 进 行 需求 分 析 和 测试 评价 的 基础 ， 同 时 也 决定 了 系统 的 工作 范围 ， 因 此 如 何 确定 测试 场景 一 直 是 
ADA3S 及 其 他 智能 汽车 安全 技术 的 研究 重点 。 


由 于 ADAS 系 统 主要 针对 安全 问题 ， 因 此 其 测试 场景 分 析 主 要 针对 危险 场景 。 目 前 最 通用 的 危险 场景 提取 方法 是 交通 事故 数据 分 析 ， 比 如 美国 高 速 公 
路 安全 管理 局 (NHTSA) 基于 2004 年 的 GES (General Estimates System) 事故 数据 库 ， 提 出 了 37 类 预 磁 撞 (Pre-Crash) 场景 。 在 这 37 类 预 页 撞 场 景 的 
基础 上 ，NHTSA 对 不 同类 型 的 事故 场景 进行 了 更 为 细致 的 定义 ,得 到 了 6 大 类 、13 小 类 事故 场景 ， 详 见 2014 版 的 GES 分 析 手 册 。 


基于 NHTSA 的 GES 等 交通 事故 数据 库 ，Kusano 等 人 分 析 提 炼 了 单车 事故 和 多 车 事故 两 大 类 共 18 小 类 事故 场景 ( 见 图 6-11) ， 然 后 将 这 些 场景 用 来 作 
为 前 碰撞 预警 (Forward Collision Warning，FCW) 等 ADAS 系 统 开发 用 目标 场景 。 


ADAS 系 统 的 开 友 和 评价 不 仪 需要 目标 场景 类 型 ， 还 需要 目标 场景 的 具体 参数 。 因 此 ， 在 事故 场景 分 析 的 基础 上 ， 欧 盟 项 目 ASSESs 通 过 对 GIDAS、 
STATS919、OTS、STRADA 等 深度 事故 数据 库 进 行 分 析 ， 结 合 不 同类 型 事故 的 比例 及 对 乘员 造成 的 伤害 程度 ， 对 追尾 事故 、 十 字 路 口 事故 、 迎 面 碰 撞 事 
故 、 前 方 车 辆 切入 (Cut-in) 事故 的 典型 危险 场景 进行 了 提取 ， 并 通过 统计 分 析 得 到 了 各 种 场景 中 本 车 和 目标 车 的 速度 等 信息 ， 如 表 6-1 所 示 。 
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图 6-10 Kusano 等 人 得 到 的 事故 场景 


表 6-1 ASSESS 项 目 得 到 的 典型 危险 场景 


车 速 (km/h) 





( 续 ) 


车 速 (km/h) 


场景 类 型 场景 子 类 型 
B (十字路 口 事故 ) B1/B2 (城市 场景 ) 


C (迎面 碰撞 事故 ) Cl (乡村 工 况 ) 3 


04 
D1 (迎面 来 车 ) 2 
D (前 方 车 辆 切入 ) \ et 
DZ 〈 同 向 车 辆 变 首 ) | 80 


AEB 系 统 近年 来 友 展 迅速 ， 出 于 AEB 系 统 开 及 和 测试 的 需要 ， 奶 尾 事故 场景 在 近 毕 年 成 为 研究 的 热点 。 除 了 AssE9Ss 项 目 外 ， 诸 如 eVALUE 等 项 目 以 及 
vFSS、AEB Group、ADAC 等 第 三 方 机 构 都 利用 GIDAS 等 深度 事故 数据 库 数据 对 典型 的 事故 类 型 尤其 是 追尾 事故 的 典型 危险 场景 进行 了 分 析 。Aparicio 等 
人 对 这 些 危 险 场景 进行 了 总 结 ， 这 些 场景 是 Euro-NCAP 的 AEB 测 试 场景 以 及 IIHs 的 CIB 测 试 场景 的 基础 。 其 中 ，Euro-NCAP 的 AEB 测 试 场景 如 图 6-11 所 
示 ， 已 经 从 2014 年 开始 正式 引入 Euro-NCAP 的 整 车 安全 性 评价 体系 中 。 
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图 6-11 Euro-NCAP 的 AEB 系 统 测试 场景 


行人 事故 场景 是 另外 一 个 研究 的 热点 ， 欧 盟 项 目 APROSYS 基 于 GIDAS 中 649 例 车 与 行人 发 生 的 正 碰 事 故 ， 提 取 了 6 类 典型 的 车 -行人 碰撞 事故 场 
景 ，R.de Lange 对 这 些 场景 进行 了 总 结 ， 并 提炼 出 了 三 大 类 行人 事故 危险 场景 ， 如 表 6-2 所 示 。 


表 6-2 APROSYS 事 故 场景 参数 









条 件 
_ - 对 应 实际 
场景 车 辆 速度 碰撞 速度 行人 速度 事故 占 比 


(km/h) ( km/h) ( km/h) 


S50 +20 . 7 晚 59% 
右 侧 ) 过 公路 ， 有 45 +25 
遮挡 


车 辆 ( 左 、 右 ) 转 
过 后 行人 《4 左 、 市 2 二] 白天 夜晚 7.1% 
侧 ) 过 公路 


ASPECSS 项 目 也 基于 GIDAS、STATS19、SETRA 数 据 库 对 提取 了 上 典型 的 行人 事故 场景 。Lenard 等 人 基于 STATS19 和 和 OTS 数据 库 ， 通 过 系统 聚 类 法 得 到 
了 典型 的 行人 事故 危险 场景 ， 采 用 聚 类 分 析 的 方法 较 好 的 避免 了 研究 人 员 主 观 判断 对 结果 的 影响 。 基 于 这 些 研究 结果 ，Euro-NCAP 推 出 了 行人 AEB 系 统 测 
试 草案 ， 其 中 测试 场景 如 图 6-12 所 示 ， 该 草案 将 从 2016 年 开始 正式 执行 。 
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图 6-12 ”Euro-NCAP 行 人 AEB 系 统 测试 场景 草案 


从 交通 事故 数据 中 可 以 获取 上 典型 的 危险 形态 ， 但 能 得 到 的 参数 不 多 ， 准 确 性 也 有 限 ， 更 为 重要 的 是 缺乏 交通 事故 的 主要 诱因 一 一 驾驶 员 行 为 数据 。 
此 ， 随 着 研究 的 深入 ， 自 然 驾 驶 研究 和 实证 测试 逐渐 受到 行业 和 研究 人 员 的 重视 。 


在 实际 雪 驶 过 程 中 所 有 的 驾驶 状态 可 用 图 6-13 表 示 ， 通 单 情况 下 驾驶 员 处 在 正 冲 驾驶 状态 。 如 果 雪 驶 员 的 操作 与 当前 的 驾驶 环境 不 相 匹 配 ， 危 险 超过 
了 轨 驶 员 的 前 摄 限 ， 则 进入 冲突 状态 。 如 果 特 驶 员 采 取 正 确 的 纠正 操作 ， 回 到 了 正 弟 驾 驶 状态 ， 这 个 过 程 称 为 临 础 撞 (Near-Crash) 。 如 果 雪 驶 员 没有 进 
行 正 确 的 纠正 操作 ， 人 危险 超过 了 驾驶 员 的 反应 限 ， 那 么 将 会 导致 事故 友 生 。 可 见 ， 事 故 只 是 真实 交通 工 况 中 一 个 很 小 的 片段 ， 利 用 NDS (FOT) 数据 还 可 
以 得 到 临 碰撞 和 冲突 场景 ， 对 交通 危险 的 形态 和 友 生 原因 进行 更 为 深入 的 了 解 。 同 时 ， 从 NDS (FOT) 中 还 可 以 检验 从 事故 数据 中 得 到 的 场景 在 真实 交通 
工 况 中 的 代表 性 。 例 如 美国 IVBSS 项 目的 最 终 报 告 根据 数据 分 析 结 果 推 荐 了 一 套用 于 一 体 化 汽车 安全 系统 的 测试 场景 。Nobuyuki 等 人 利用 NDS 数 据 提取 了 


日 本 的 典型 事故 形态 和 场景 ，Yuasa 等 人 先 通过 日 本 的 ITARDA 数 据 库 提 取 了 典型 的 车 -行人 碰撞 事故 场景 ， 然 后 基于 目 然 轨 驶 工 况 数据 对 这 些 场 景 的 详细 
参数 进行 了 提取 。 
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图 6-13 ”不同 驾驶 状态 的 转移 关系 


6.2.3 ”高 等 级 目 动 考 驶 车 辆 测试 评 作 万 法 


谷歌 无 人 驾驶 车 辆 的 基于 实际 道路 的 测试 方法 属于 上 一 节 中 谈 到 的 实证 测试 (FOT) ， 从 前 面 章节 论述 可 知 ， 要 证 明 自动 驾驶 比 人 类 驾驶 更 加 安全 ， 
全 少 需 要 通过 超过 数 亿 黄 里 的 实证 测试 ， 这 一 来 耗 时 巨大 ， 成 本 遍 昂 ， 不 具备 可 操作 性 ， 二 来 也 不 能 满足 目 动 当 驶 车 辆 开 友 快速 和 迭代 的 需要 。 针 对 局 等 级 
自动 驾驶 当前 国际 上 并 没有 成 熟 系 统 的 测试 评价 方法 提出 ， 不 过 可 以 参考 ADAs 的 测试 评价 体系 ， 构 建 兼容 高 等 级 自动 驾驶 的 智能 网 联 汽车 测试 评价 体 


如 图 6-14 所 示 ， 依 然 采 用 由 仿真 、 轨 驶 模拟 、 受 控 场 地 测试 和 实证 测试 构成 的 测试 体系 ， 但 这 里 的 场景 库 不 再 是 ADAs 测 试 评价 所 需 的 典型 场景 ， 而 
该 是 与 目 动 驾驶 车 辆 ODD 相 天 的 所 有 场景 的 全 集 。 从 功能 完备 性 的 角度 考虑 ， 场 景 库 中 的 场景 数量 将 远 远 超过 ADAs 评 价 所 需 的 场景 ， 理 论 上 讲 ， 应 该 
至 少 等 同 于 需要 证 明 自动 驾驶 系统 比 人 为 驾驶 更 为 安全 所 需 的 驾驶 里 程 中 所 可 能 遇 到 的 所 有 场景 。 


刁 


相关 场景 数据 库 





图 6-14 ”自动 驾驶 车 辆 测评 方法 


设 针对 某 自动 驾驶 车 辆 ODD 得 到 的 相关 场景 库 中 总 共有 X00 个 场景 ， 首 先 通 过 仿真 测试 ， 将 自动 各 驶 车 辆 的 相关 算法 在 这 X00 个 场景 中 进行 测试 评 
价 。 通 过 仿真 测试 后 可 以 确定 出 与 系统 更 为 相关 且 更 为 关键 的 场景 ， 将 X00 个 场景 减少 到 Y 个 ， 用 于 各 驶 模拟 器 测试 ， 在 当前 阶段 ， 驾 驶 模拟 器 可 用 于 提炼 
和 验证 竟 行 交通 下 目 动 驾驶 车 辆 与 人 为 驾驶 车 辆 之 间 的 交互 以 及 目 动 驾驶 车 辆 之 间 的 交互 ， 这 些 场景 目前 在 实际 交通 中 尚 无 法 得 到 。 通 过 驾驶 模拟 测试 
后 ， 目 动 驾驶 千 辆 的 设计 可 以 得 到 优化 并 应 用 到 合适 的 样 车 中 ， 同 时 对 相关 场景 进一步 提炼 ， 将 场景 数量 减少 到 Z， 这 2Z 个 场景 将 用 于 受 控 场地 测试 。 受 控 
场地 测试 结果 用 来 对 自动 驾驶 车 辆 的 开发 进行 最 终 定型 ， 理 论 上 讲 ， 通 过 场地 测试 后 针对 该 自动 驾驶 车 辆 的 所 有 X00 个 场景 都 应 该 覆盖 ， 系 统 必须 在 仿真 
测试 ， 和 驾驶 模拟 测试 和 受 控 场 地 测试 中 的 所 有 场景 下 都 取得 满意 的 效果 。 最 后 ， 所 开 友 的 自动 驾驶 车 辆 通过 FOT 测 试 进行 系统 的 最 终 验 证 。 同 时 ， 从 FOT 
测试 中 友 现 的 新 的 场景 ， 可 以 进一步 丰富 场景 库 ， 辅 助 自动 驾驶 车 辆 性 能 优化 升级 或 新 的 智能 网 联 汽车 功能 开发 。 


在 这 套 测 试 体系 中 ， 场 景 数据 库 将 占据 非常 关键 的 作用 ， 它 是 所 有 测试 评价 的 出 发 点 和 基础 。 场 景 数据 库 可 通过 事故 数据 库 '，NDS/FOT 数 据 库 和 一 些 
针对 自动 驾驶 的 预期 工 况 (在 实际 道路 中 可 能 出 现 但 在 当前 尚 不 能 从 实际 驾驶 环境 中 获得 ) ， 如 图 6-16 所 示 。 这 个 基础 数据 库 是 自动 驾驶 车 辆 设计 和 测试 
评价 的 基础 ， 需 要 论 费 大 量 人 力 物力 构建 ， 国 外 已 经 通过 大 量 的 深度 事故 数据 库 和 NDS/FOT 项 目 数据 进行 构建 。 目 前 以 上 海 国际 汽车 城 (集团 ) 有 限 公司 
牵涉， 集合 国家 智能 网 联 汽 车 (上海) 试点 示范 区 相关 资源 正在 开展 “昆仑 计划 ”， 提 炼 适合 中 国 交通 环境 的 智能 驾驶 全 息 场 景 库 ， 集 合 交 通 事 故 数据 、 
自然 驾驶 数据 、 驾 驶 模拟 数据 、 路 侧 采 集 数 据 、 标 准 规范 数据 以 及 自动 重 构 数据 等 六 大 类 数据 资源 ， 打 造 覆 苹 智 能 网 联 汽 车 开发 验证 全 过 程 的 全 息 场 景 
库 ， 是 国内 当前 最 前 治 也 最 系统 的 场景 库 研 究 和 建设 工作 。 目 前 “昆仑 计划 ”已 经 取得 阶段 性 进展 ， 汇 聚 了 超过 4000 多 例 深度 交通 事故 分 析 数 据 、1250 余 
万 干 米 目 然 驾 驶 数据 、1270 余 组 路 侧 摄 像 头 采 集 数 据 、80 余 类 标准 规 学 数据 ， 并 且 已 经 初步 建立 了 多 维 场景 要 素 解构 和 重 构 技术 。 
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资料 来 源 : 上 海 国 际 汽车 城 官网 。 


图 6-16 是 事故 数据 库 和 FOT 数 据 库 的 来 源 ， 这 些 数据 可 以 通过 更 多 的 FOT 数 据 进 行 补 苑 ， 但 是 也 仪 仅 限 于 可 测量 的 状态 空间 中 。 这 样 数 据 库 会 确实 一 
些 比 如 自动 驾驶 车 辆 和 人 为 驾驶 车 辆 之 间 的 交互 ， 以 及 自动 驾驶 车 辆 之 间 的 交互 的 数据 。 因 为 高 等 级 的 自动 驾驶 乃至 无 人 轰 驶 绝 大 部 分 还 处 于 研制 或 测试 
阶段 ， 还 没有 进入 市 场 ， 这 些 车 辆 之 间 的 交互 以 及 与 人 为 驾驶 车 辆 之 间 的 交互 目前 并 不 存在 于 真实 的 交通 环境 中 。 因 此 ， 场 景 数据 库 需 要 通过 某 种 方式 进 
行 扩充 ， 比 如 在 没有 样 车 的 时 候 通 过 各 驶 模拟 器 获取 自动 驾驶 和 人 类 驾驶 之 间 的 交互 场景 ， 以 及 目 动 驾驶 功能 的 边界 条 件 (尤其 是 第 3 级 的 有 限 目 动 驾 
驶 ) ; 当 有 样 后 后 ， 可 以 在 一 个 更 为 受 控 的 测试 环境 ， 比 如 封闭 试验 场 进行 测试 获取 目 动 驾驶 与 人 为 驾驶 之 间 、 目 动 驾驶 之 间 的 交互 场景 ; 另外 ， 智 能 网 
联 汽车 示范 区 是 推动 数据 库 建 设 的 一 个 有 力 工具 ， 利 用 示范 区 内 的 先行 先 试 ， 可 以 获得 更 为 真实 的 交互 场景 。 
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图 6-16 ”场景 库 的 生成 方法 


另外 ， 由 于 场景 参数 是 随机 的 ， 通 过 实际 的 测试 只 能 获取 部 分 数据 ， 大 量 的 “上 暗物质 ”场景 并 不 能 通过 实际 的 测试 或 者 采集 获得 ， 因 此 通过 蒙特 卡 洛 
采样 、 重 要 性 采样 等 方法 可 以 对 采集 数据 进行 扩充 ， 引 入 随机 变量 ， 比 如 速 厌 、 路 径 、 交 通 特征 参数 等 ， 这 会 进一步 增加 和 完善 场景 状态 空间 。 不 过 ， 场 
景 要 素 的 组 合 规 律 并 不 一 定 服从 随机 分 布 而 是 受到 道路 交通 设计 规范 、 交 通 法 规 等 相关 的 一 些 约束 ， 场 景 要 素 的 组 合 规律 需要 通过 大 量 已 有 的 数据 进行 分 
析 和 研究 。 


在 这 套 测试 方法 中 ， 为 了 达到 “加 速 ”测评 的 效果 ， 仿 真 测试 将 占据 非常 重要 的 地 位 。 仿 真 测试 除了 对 自动 驾驶 车 辆 算法 进行 测评 之 外 ， 还 作为 相关 
场景 的 一 种 筛选 方式 ， 提 炼 出 更 为 相关 和 关键 的 场景 用 于 后 续 的 尝 驶 模拟 和 场地 测试 ， 以 提高 测试 效率 。 当 前 ， 通 过 并 行 计算 等 方式 可 大 大 提高 计算 机 仿 
真 的 速度 ， 谷 歌 宣称 其 无 人 驾驶 仿真 测试 系统 一 天 可 以 模拟 300 万 英里 里 程 的 测试 ， 这 代表 着 未 来 的 潮流 ， 国 内 百度 、 上 汽 、 上 海 国际 汽车 城 、 同 济 大 学 
等 也 在 开展 相关 研究 。 


6.3 ”智能 网 联 汽 车 综合 试验 场 


如 前 所 述 ， 智 能 网 联 汽 车 正 逐 渐 从 驾驶 辅助 系统 同 高 等 级 目 动 驾驶 方向 友 展 ， 进 行 受 控 场地 测试 所 需要 复 现 的 交通 场景 也 会 越 来 越 多 且 越 来 越 复 杂 ， 
传统 的 试验 场 已 经 不 能 满足 自动 驾驶 车 辆 功能 开发 和 验证 的 需要 ， 当 前 世界 上 欧 、 美 、 日 等 国家 和 地 区 都 在 建设 智能 网 联 汽 车 专用 试验 场 ， 通 过 测试 评价 
和 示范 应 用 解决 智能 网 联 汽 车 在 实际 运营 中 的 技术 难题 ， 推 动 自动 驾驶 与 V2X 技 术 的 发 展 ， 引 导 产 业 标 准 规范 的 制定 ， 抢 占 智能 网 联 汽 车 行业 优势 地 位 。 
我 国 相关 部 委 及 地 方 政 府 对 智能 网 联 汽车 产业 及 展 的 重视 程度 也 不 断 上 升 ， 以 国家 智能 网 联 汽车 (上海) 试点 示范 区 为 代表 的 各 地 示范 区 建设 也 陆续 加 
快 ， 掀 起 了 建设 试验 场 的 热潮 ， 以 推动 智能 网 联 汽车 的 技术 友 展 和 测试 验证 。 


目前 ， 国 内 受 法 律 法 规 等 的 限制 ， 高 等 级 自动 驾驶 车 辆 尚 不 能 进入 公共 道路 测试 ， 这 对 于 车 辆 技术 验证 和 性 能 升级 ， 以 及 相 天 场景 的 提取 和 完善 都 产 
生 了 很 多 的 限制 。 但 上 自动 驾驶 车 辆 上 路 是 一 个 系统 的 工程 ， 在 促进 技术 进步 的 同时 必须 保障 公共 安全 且 不 会 干扰 正常 的 交通 秩序 。 因 此 ， 建 设 智能 网 联 汽 
车 专用 试验 场 对 智能 网 联 汽 车 新 技术 的 安全 性 、 交 通 依 从 性 等 进行 验证 ， 也 是 支撑 建立 自动 驾驶 进入 公共 道路 准 入 规范 等 标准 规范 及 行业 晤 管 体系 的 基 
础 。 


6.3.1 国外 智能 网 联 汽车 综合 试验 场 


1. 美 国 


美国 在 智能 汽车 和 基于 V2X 的 网 联 汽 车 相关 的 研究 领域 一 直 走 在 世界 的 前 列 。 近 几 年 ， 美 国 分别 开 展 了 VIll、CVHAS 和 intelliDrive 等 项 目 ， 强 调 及 用 
人 -车 -路 一 体 化 方法 来 解决 现代 交通 所 存在 的 严重 问题 。 另 外 ， 为 了 推动 智能 网 联 汽车 技术 的 研发 和 产业 化 ， 美 国 已 经 建设 了 数 个 智能 网 联 汽车 专用 试验 
场 ， 如 图 6-18 所 示 。2015 年 7 月， 全 球 诈 个 目 动 驾驶 封闭 测试 区 M-City 正 陈 开园 并 引 上 及 了 广泛 天 注 ， 也 推动 了 世界 各 国 竞 相 开展 目 动 驾 驶 测试 场 的 建设 。 
2016 年 11 月 ， 美 国 交 通 部 公布 “ 目 动 驾驶 试验 场 试点 计划 ”， 并 于 2017 年 1 月 19 日 确立 了 10 家 目 动 驾 驶 试点 试验 场 。 





MCity, 密歇根 


图 6-17 美国 智能 网 联 汽车 专用 试验 场 


M-City 从 2014 年 开始 建设 ， 是 世界 上 首 个 测试 智能 汽车 、V2V/V2| 车 联网 技术 的 专用 封闭 测试 场 ， 由 密 软 根 大 学 移动 交通 研究 中 心 负责 建设 运营 。 测 
试 场 位 于 密 软 根 州 安娜 堡 市 密 吹 根 大 学 校园 内 ， 占 地 194 责 ， 车 道 线 总 长 约 8 干 米 ， 设 置 有 多 种 道路 和 路 侧 设 施 模 拟 实际 道路 环境 ， 主 要 包括 用 于 模拟 高 速 
公路 环境 的 高 速 实验 区 域 和 用 于 模拟 市 区 与 近郊 的 低速 实验 区 域 。 


M-City 的 最 大 特点 是 柔性 设计 ，M-City 中 包含 丰 语 的 道路 环境 要 素 ， 如 不 同 的 车 道 线 、 人 行道 、 行 人 斑马 线 、 上 自行 车 道 、 街 灯 、 无 障碍 坡 道 ， 不 同形 
式 的 停车 位 、 公 共 汽 车 站 ， 还 有 不 同形 式 的 郊区 街道 、 交 区 干线 、 农 村 道路 、 高 速 公路 、 坡 道 、 环 状 交 又 路 口 、 圆 形 交 叉 路 口 和 复杂 的 斜 式 交 叉 路 口 等 道 
路 形态 ， 这 些 元 素 经 过 组 合 能 够 复 现 多 种 真实 交通 场景 ， 最 大 限度 地 支撑 智能 网 联 汽车 测试 对 场景 完备 性 的 需求 ( 见 图 6-18) 。 









M-Clty 
M-City 由 60 余 家 企业 共同 使 用 ， 包括 汽车 制 
造 商 、 大 学 、 研 究 机 构 等 ， 主 要 进行 目 动 芍 驶 





开放 测试 















和 电动 安全 系统 的 测试 与 开发 。 在 M-City 内 ， i 
布 有 不 同 的 道路 、 交 又 路 口 以 及 V21， 充 分 模 ee 
拟 现 实 路 况 。 测 试 区域 面 积 为 0.13 平 方 千 米 :特殊 的 交叉 路 


( 13 万 平方 米 ) 
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全 直道 和 弯 道 
树木 路 段 ， 模 拟 无 
线 电 信和 号 经 过 树木 之 金属 架 桥 ， 测 试 
后 被 削弱 的 情况 雷达 与 图 像 处 理 传 
带 交通 信号 灯 的 交 感 器 的 应 对 能 力 
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图 6-18 M-City 功 能 示意 图 


2015 年 11 月 ，M-City 迎 来 了 对 外 开放 以 来 的 第 一 家 汽车 制造 厂商 测试 用 户 一 一 福特 汽车 。 福 特 在 M -City 测 试 了 其 研发 的 混合 动力 无 人 驾驶 汽车 ， 汽 
车 搭载 摄像 头 、 激 光 雷 达 、3D 测 绘 系统 等 传感器 ， 这 些 传感器 能 够 感知 M-City 的 道路 环境 ， 做 出 相应 的 反应 ， 实 现 无 人 驾驶 。 前 福特 全 球 产 品 开发 副 总 裁 
拉 杰 : 耐 尔 (Raj Nair) 评价 : M-city 提 供 了 真实 的 城市 环境 ， 能 够 安全 、 可 靠 、 可 重复 地 进行 新 技术 测试 ， 这 是 无 人 驾驶 汽车 测试 迈 出 的 重要 一 步 。 


另外 ， 美 国 交通 部 指定 的 十 大 智能 网 联 汽车 专用 试验 场 分 布 于 9 个 州 见 (图 6-20) ， 分 别 位 于 美国 的 东北 部 、 东 部 、 东 南部 、 北 部 、 中 西部 、 南 部 、 
西部 、 西 南部 ， 实 现 了 美国 交通 部 希望 的 地 区 发 展 平衡 。 这 些 分 布 在 美国 各 地 的 专用 试验 场 具 有 差异 化 的 气候 条 件 和 地 独特 征 ， 使 智能 汽车 可 以 在 更 加 丰 
襄 的 条 件 下 开展 测试 。 


2. 欧 洲 


瑞典 的 AstaZero 试 验 场 忌 面积 约 200 万 平方 米 ， 为 复 现 各 类 上 典型 应 用 场景 ， 试 验 场 设 计 了 四 个 主要 的 测试 区 ( 见 图 6-20) 。 最 外 圈 为 5.7 干 米 的 环 道 ， 
用 于 模拟 乡村 道路 ， 该 部 分 道路 为 双向 两 车 道 ， 一 半 道 路 设计 设计 时 速 为 70km/h， 另 外 一 半 道 路 为 900km/h; 乡村 道路 最 大 的 目的 是 用 于 驾驶 行为 测试 ， 


这 部 分 道路 行驶 环境 相当 单调 ， 容 易 使 得 驾 


体 马 


驶 员 注 意 力 不 集 中 ， 道 路 两 侧 栽 种 有 灌木 从 等 ， 起 到 隐藏 障碍 物 的 作用 ， 测 试 路 侧 突然 有 障碍 物 富 出 时 驾驶 员 
的 反应 ;2 处 T 字 交叉 路 口 和 1 处 十 字 路 口 ， 路 口 标志 牌 可 根据 测试 需 


es 
划 行 更 换 ， 部 分 标志 牌 可 以 电子 控制 ; 1 处 公交 车 站 及 1 处 紧急 停车 市 。 乡 村 道路 还 
可 用 于 V2X、ACC 目 适应 巡航 控制 、 上 自动 驾驶 、 人 机 交互 界面 《HMI1) 等 的 测试 。 
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图 6-20 AstaZeto 试 验 场 


城市 道路 当前 由 四 个 建筑 物 围 成 的 一 个 十 字 路 口 构成 ， 未 来 将 新 增 五 个 街区 ( 见 图 6-21 和 图 6-22) ， 主 要 用 于 模拟 城市 交通 工 况 ， 主 要 测试 车 辆 与 行 


人 、 汽 车 、 大 巴 等 其 他 道路 使 用 者 避免 碰撞 的 能 力 。 四 个 建筑 物 每 个 长 40m， 宽 25m， 高 4m， 其 中 三 个 为 “ 假 ” 建 筑 物 ， 只 有 外 墙 ， 外 墙 上 绘制 有 建筑 外 
表面 图 案 ， 能 够 骗 过 人 有 眼 及 和 车载 传感器 ， 另 外 一 个 用 于 存储 目标 物 等 测试 设备 ， 具 有 不 同 宽度 和 车 道 数 的 道路 ， 同 时 有 和 人行横道 、 人 行道 、 非 机 动车 道 、 
公交 车 道 等 ; 为 了 让 进入 测试 区 时 的 速度 达到 要 求 ， 在 进入 十 字 路 口 前 有 超过 150m 长 的 加 速 道 ; 主 街道 照明 可 分 块 控制 ， 并 配备 有 交通 标志 安装 接口 ， 可 


根据 测试 需要 进行 更 换 ， 同 时 提供 电动 车 的 充电 接口 。 


a 这 







与 乡村 道路 
的 接口 
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图 6-21 ”城市 道路 构成 示意 图 


高 速 道路 区 域 主要 用 于 避 撞 技术 及 车 辆 动力 学 测试 ( 见 图 6-23) ， 该 区 域 由 一 个 直径 240m 的 操 稳 广场 以 及 三 条 加 速 道 构成 ， 其 中 两 条 加 速度 长 约 
1000m， 另 外 一 条 加 速度 长 约 600m， 可 以 达到 很 高 的 测试 速度 ， 为 保证 安全 ， 整 个 高 速 测试 区 域 都 用 刚性 护栏 包围 ， 并 设置 组 中 垫 ; 采 用 气球 车 、 假 人 


等 目标 物 模 拟 真实 的 车 辆 和 行人 ， 目 标 物 可 远程 控制 ; 测试 车 辆 可 采用 驾驶 机 器 人 驾驶 。 高 速 交 叉 路 口 场景 、 高 速 对 向 行驶 场景 都 可 以 在 该 区 域 中 进行 复 


现 。 





图 6-22 ”城市 道路 测试 图 
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图 6-23 ”高 速 道 路 区 域 
妆 相 连 。 中心 隔离 市 等 可 临时 设置 ， 行 驶 方向 可 随时 变换 ;， 带 有 龙门 架 、 


多 和 车道 局 域 模拟 高 速 道 路 由 四 条 车 道 构成 ， 长 约 700m,， 与 操 稳 广场 直接 相 
， 灯 光照 明 可 分 块 控制 。 除 自动 驾驶 外 ， 诸 如 紧急 制 动 、 盲 区 检测 、 变 道 提 醒 等 场景 都 可 以 在 该 区 域 中 进行 复 现 ( 见 图 6-24) 。 
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图 6-24 ”多 车 道 区 域 
乡村 道路 、 多 车 道道 路 以 及 高 速 测试 区 域 的 加 速 道路 全 程 铺设 管道 用 于 电力 、 光 纤 等 线路 的 布置 ， 每 隔 150m 设 置 一 个 接 入 点 ;架设 GPS 定 位 基站 ， 著 


善 整个 测试 区 域 ， 目 标 车 都 囊 有 基于 RTK 的 GPs 移 动 站 ; 配备 模拟 行人 、 和 车辆 、 汽 车 人 、 动 物 的 目标 物 ， 且 可 远程 自动 控制 ; 所 有 区 域 覆 盖 WiFi 信 和 号。 


西班牙 IDIADA 公 司 充分 利用 其 现 有 试验 场 进 行 智能 系统 的 测试 工作 。 试 验 场 配 备 了 现代 化 的 通信 技术 ， 如 802.11p、3G/4G 等 ， 此 外 配备 了 高 精度 卫 
星 定 位 系统 ， 定 位 精度 +40cm (10Hz) 。 测 试 内 容 包括 ADAS、ITS、V2V、V2l 等 ， 试 验 场 拥有 大 量 试验 设备 ， 如 假 人 、 假 车 等 。 如 图 6-25 所 示 。 





图 6-25 IDIADA 试 验 场 


英国 MIRA 的 City Circuit 试 验 场 主要 用 于 模拟 城市 工 况 ， 可 提供 车 辆 实时 监控 以 及 现代 化 的 通信 技术 ， 如 GSM、 蜂 富 网 络 、 无 线 网 络 和 802.11p。 试 
验 场 拥 有 长 300m 的 多 和 车道 高 速 路 、 各 种 路 面 、 道 路 接口 和 交叉 口 、 种 类 齐全 的 道路 标记 、 全 道路 电源 和 网 络 、 用 户 自 定义 交通 信和 号， 可 双向 行驶 ， 提 供 特 
殊 技 术 服 务 等 ， 可 用 于 IT 等 技术 的 研究 和 开 友 ， 如 图 6-26 所 示 。 
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图 6-26 ”City Citrcuit 试 验 场 (MIRA) 


日 本 是 最 早 开 展 车 联网 相关 技术 研究 的 国家 。20 世 纪 80 年 代 早 期 ,日 本 JSK (The Association of Electronic Technology for Automobile Traffic 
and Driving) 就 开始 了 车 -车 间 无 线 通信 的 研究 。 之 后 开展 的 多 个 智能 交通 项 目 也 将 车 -车 通信 技术 的 应 用 作为 研究 重点 之 一 ， 有 具有 代表 性 的 项 目 是 VICS 
项 目 、ASV 计 划 、SmartWay 计 划 、AHS 和 CHAUFFEUR 项 目 。 目 前 日 本 在 基于 车 -车 通信 的 车 队 车 辆 控制 和 协作 驾驶 应 用 方面 ， 已 基本 完成 了 基础 技术 和 
实用 技术 的 研发 ， 在 此 方面 超出 欧美 处 于 世界 领先 地 位 。 在 智能 网 联 汽 车 测试 方面 ， 日 本 的 研究 基本 上 是 由 车 企 推动 的 ， 比 较 有 代表 性 的 是 丰田 东 富 士 研 
究 所 ITS 试 验 场 。 


丰田 一 直 致 力 于 IT 技术 的 推广 和 研究 ， 力 求 通过 ITs 技 术 减 少 交 通 事故 。 为 此 ， 丰 田 于 2014 年 2 月 在 忒 富士 研究 所 设立 TS 试验 场 ( 见 图 6-27) 。 试 验 
场 占 地 3.5 公 项 ， 可 以 利用 700MHz 的 无 线 频 段 进行 通信 试验 。 试 验 场 内 布置 了 车 辆 探测 妆 置 、 行 人 探测 委 置 、 信 号 灯 、 通 信 闪 置 等 各 种 设备 ， 同 时 ， 和 车辆 
自身 也 搭载 了 数据 采集 装置 和 通信 装置 ， 可 以 满足 各 种 IT9 相 关 测 试 的 要 求 。 丰 田 在 试验 场 内 主要 对 右 转 弯 防 碰撞 辅助 等 四 种 安全 名 驶 辅助 功能 进行 了 测 
试 ， 并 取得 了 比较 理想 的 研究 数据 。 
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罗 试验 场 内 有 多 种 实验 和 
一 探测 装置 ， 另 外 也 有 普 
通信 号 灯 ， 可 以 进行 与 
ITS 相 关 的 各 种 试验 。 


图 6-27 丰田 东 富 士 研究 所 ITS 试 验 场 


国家 智能 网 联 汽车 (上 海 ) 试点 示范 区 第 一 期 建设 主要 包含 三 块 封闭 测试 区 ， 其 中 最 主要 的 是 位 于 上 海 F1 赛 车 场 南 侧 的 测试 区 F-Zone ( 见 图 6- 
28) ，F-Zone 是 国内 第 一 个 专门 用 于 智能 网 联 汽车 测试 的 封闭 试验 场 。F-Zone 占 地 面积 2 平方 干 米 ， 可 用 于 测试 的 道路 近 4 干 米 ， 建 设 了 1 个 GPS 差 分 基 
站 、1 个 北斗 地 基 增 强 站 、2 座 LTE-V 通 信 基 站 、24 套 DSRC 和 5 套 LTE-V 路 侧 单 元 、6 个 智能 红绿灯 、3 套 高 精度 地 图 和 40 个 各 类 摄像 头 ， 整 个 测试 区 道路 实 
现 了 北斗 /GPS 系 统 的 厘米 级 定位 和 WiFi 的 全 获 蘑 ， 完 成 了 隧道 、 林 靖 道 、 砖 石 路 、 相 油 路 、 碎 石 路 、 加 ; 山 / 充 电站 、 地 下 停车 场 、 十 字 路 口 、 丁 字 路 口 、 
铁道 口 、 圆 形 环岛 、 气 象 模 拟 、 事 故 模拟 、 湿 滑 道 路 、 无 线 充电 等 道路 环境 ， 并 且 配 备 了 移动 平台 车 、 标 准 假 人 等 国际 先进 的 专用 测试 设备 ， 可 以 为 自动 


驾驶 和 V2X 网 联 汽车 提供 200 多 种 场景 的 测试 验证 。 
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国家 智能 网 联 汽 车 (上海 ) 试 点 示范 区 
National Intelligent Connected Vehicle [Shanghail Pilot Zone 


图 6-28 国家 智能 网 联 汽 车 (上海 ) 试点 示范 区 封闭 测试 区 (F-Zone) 
F-Zone 于 2016 年 6 月 7 日 正式 对 外 开园 ， 截 至 2017 年 11 月 ， 已 囚 计 为 上 汽 、 通 用 、 沃 尔 沃 、 德 尔 福 等 30 多 家 OEM 和 零 部 件 供应 商 提 供 了 超过 360 天 次 
的 持续 性 测试 服务 和 研发 支持 ， 得 到 了 行业 内 的 高 度 认 可 和 社会 上 的 广泛 关注 ， 已 经 成 为 我 国 智能 网 联 汽 车 测试 能 力 最 全 、 技 术 水 平 最 先进 、 影 响 力 最 大 


的 窗口 。 








图 6-29 ”同济 智能 网 联 汽车 综合 测评 基地 


位 于 同济 大 学 嘉定 校区 内 的 智能 网 联 汽车 综合 测评 基地 (T-Zone) 是 国家 智能 网 联 汽车 (上 海 ) 试点 示范 区 第 一 期 建设 的 重要 内 容 之 一 ， 是 示范 区 教 
学 和 科研 的 主要 承载 区 。 基 地 位 于 同济 大 学 嘉定 校区 校园 内 ， 当 前 占 地 约 170 亩 ， 后 期 预计 将 扩展 到 230 亩 ， 如 图 6-29 所 示 ， 基 地 主要 用 于 城市 及 乡村 道路 
的 环境 模拟 。 基 地 同样 履 盖 DSRC 和 LTE-V 两 种 模式 的 V2X 通 信 环 境 ， 满 足 网 联 汽 车 测试 对 通信 的 需要 ， 同 时 还 专门 打造 了 一 块 用 于 无 人 驾驶 测试 的 基础 功 
能 测试 区 ， 仿 照 驾驶 人 考 轨 照 的 过 程 ， 对 无 人 驾驶 车 辆 进行 “体检 ” (环境 感知 和 控制 执行 能 力 测试 ) 。 同 时 ， 结 合同 济 大 学 已 有 的 仿真 测试 能 力 以 及 八 
自由 度 高 保 真 驾驶 模拟 器 ， 基 地 内 还 将 建设 车 辆 在 环 测试 试验 平台 ， 打 造 覆 盖 智 能 网 联 汽车 研发 的 一 体 化 测试 工具 链 。 


2015 年 8 月 ， 常 熟 市 人 民政 府 联合 西安 交通 大 学 、 中 国 科学 院 自 动 化 研究 所 、 长 安 大 学 和 青岛 智能 产业 技术 研究 院 ， 在 江苏 省 常熟 高 新 技术 产业 开发 
区 ， 联 合成 立 中 国 智能 车 综合 技术 研发 与 测试 中 心 ( 见 图 6-30) 。 


中 国 智能 车 综合 技术 研发 与 测试 中 心 
Intelligent Vehicles Proving Center (1VPC) 
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图 6-30 “中 国 智能 车 综合 技术 研发 与 测试 中 心 ”规划 图 


中 心 将 规划 建设 静态 检测 实验 室 、 数 据 中 心 等 室内 场地 和 机 动车 测试 外 场 。 其 中 ， 室 内 场地 主要 通过 模拟 驾驶 场景 ， 结 合 测评 设备 ， 在 仿真 环境 中 完 
成 智能 车 辆 测试 。 中 心 将 提供 智能 车 测试 环境 和 测试 服务 ， 车 辆 标准 制定 和 设计 参考 ， 为 公共 技术 服务 、 技 术 交 易 和 项 目 合 作 给 予 平台 支撑 。 


测试 外 场 将 模拟 构建 典型 的 现实 交通 场景 ， 并 对 道路 基础 设施 和 交通 信号 灯 进 行 智能 车 专用 改造 。 场 地 内 除了 设置 常规 的 直道 、 弯 道 、 交 又 路 口 、 隧 
道 、 林 瑚 道 等 交通 场景 外 ， 包 括 了 交通 出 行 中 难以 驾驶 的 特殊 场景 ， 例 如 障碍 物 避 让 、 停 和 车场、 桥梁、 环岛、 铁路、 小 学 等 。 此 外 ， 中 心 还 研发 无 人 驾驶 
车 辆 的 在 物流 、 出 租车 等 方面 的 综合 性 应 用 。 包 括 测试 无 人 加 驶 运输 车 辆 ， 提 供 结合 基于 位 置 的 物流 服务 ,测试 无 人 驾驶 出 租车 ， 灵 活 运 载 乘 客 。 该 中 心 
计划 通过 前 三 年 的 建设 ,满足 车 联网 研 友 与 测试 的 需要 ， 后 五 年 逐步 开局 有 关 智 能 交通 项 目的 测试 。 
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第 7/ 草 ”智能 汽车 的 挑战 二 未 来 


智能 汽车 发展 的 过 程 束 是 现代 汽车 逐步 去 人 力 化 、 智 能 化 、 网 联 化 的 过 程 。 由 于 谷歌 、 苹 果 、 百 度 等 |T 企 业 的 强势 介入 ， 智 能 汽车 在 国内 外 已 经 炒 的 
火热 。 随 着 社会 的 进步 和 友 展 ， 在 不 远 的 将 来 ， 智 能 汽车 必定 会 依靠 其 优势 逐步 替代 传统 和 车辆。 本 章 将 从 智能 汽车 面临 的 挑战 、 目 动 哗 驶 给 人 类 市 来 的 变 
化 、 智 能 汽车 友 展 策略 以 及 可 预见 的 未 来 四 个 方面 ,分析 智 能 汽车 的 友 展 。 





7.1 智能 汽车 面临 的 挑战 
自动 各 驶 目前 面临 着 技术 性 和 非 技术 因素 两 方面 的 挑战 。 其 中 ， 非 技术 问题 主要 包括 法 律 问题 、 法 规 问题 、 个 人 隐私 等 问题 ;而 技术 问题 则 包括 安全 
问题 、 可 靠 性 问题 、 恶 劣 条 件 下 的 感知 识别 等 。 这 些 问题 给 智能 汽车 技术 的 革新 和 应 用 带 来 了 多 方面 的 挑战 


7.1.1 法律 上 的 挑战 


许多 新 兴 的 现代 科学 技术 均 会 面临 与 法 律 相 契 合 的 问题 ， 目 动 驾驶 汽车 便 是 其 中 之 一 。 这 既 体现 在 规范 的 空 日 上 ， 又 体现 在 制度 的 冲突 上 ， 给 法 律 的 
监管 带 来 诸多 挑战 。 【1] 目前 ， 各 个 国家 对 于 自动 驾驶 的 立法 仍 处 于 摸索 阶段 ， 在 此 过 程 中 ， 既 要 考虑 自动 驾驶 技术 的 先进 性 ， 又 要 考虑 责任 影响 的 可 操 
作 性 ， 使 得 立法 工作 异常 困难。 需要 指出 的 是 ， 在 上 自动 驾驶 技术 仍 不 成 熟 的 今天 ， 一 些 国家 已 经 开始 针对 智能 汽车 ， 进 行 了 法 律 条 文 上 的 修改 。 如 日 本 原 
有 的 安全 标准 不 允许 智能 汽车 测试 员 的 手 离开 方向 盘 ， 而 现在 允许 纯 自 动 驾驶 汽车 进行 道路 测试 [j。 总 体 而 言 ， 在 一 个 全 球 化 的 时 代 ， 智 能 汽车 的 推广 将 
会 在 全 球 同步 推进 ， 所 以 应 由 国际 标准 化 组 织 对 此 进行 立法 ,否则 自动 各 驶 的 推广 将 会 因为 只 有 少数 国家 的 参与 而 成 本 过 高 ， 进 展 缓慢 。 


[1] 《日 本 道路 运送 车 辆 法 》。 


7.1.2 ”责任 判定 上 的 挑战 


目 动 苞 驶 的 安全 系数 虽然 很 高 ， 但 是 交通 事故 仍 在 所 难免 。 事 故 友 生 时 ， 如 何 判定 法 律 责任 是 自动 驾驶 需求 切实 面 对 的 难题 。 当 目 动 驾驶 车 辆 导致 事 
故 发 生 时 ， 由 于 自动 驾驶 的 行驶 完全 由 智能 系统 控制 ， 智 能 系统 则 由 汽车 制造 方 、 智 能 软件 提供 方 、 导 航 定 位 服务 方 以 及 其 他 诸多 主体 的 共同 参与 组 建 ， 
于 是 在 确定 此 类 主体 的 设计 与 制造 并 无 瑕 竟 的 情形 下 ， 法 律 责任 方 的 确定 束 存 人 在 一 定 难 度 。 另 外 ， 上 自动 驾 驶 是 一 个 长 期 的 过 程 ， 在 推行 过 程 中 必定 会 出 现 
有 人 驾驶 和 上 自动 驾驶 并 行 的 阶段 ， 这 残 更 加 大 了 难度 。 


从 技术 上 来 看 ， 自 动 驾 驶 的 控制 具有 非 线性 关系 ， 容 易 受 到 外 界 因素 的 影响 ， 当 干扰 致使 汽车 无 法 控制 时 ， 干 扰 源 的 确定 也 存在 较 大 难度 <3] 。 此 
外 ， 网 络 攻击 、 病 毒 入 侵 、 紧 急 避 险 等 多 种 复杂 情形 下 ， 责 任 主体 的 认定 及 法 律 责任 的 实现 也 并 非 易 事 【4] 。 


7.1.3 个 人 隐私 权 的 挑战 


自动 驾驶 是 与 互联 网 高 度 结合 的 一 项 技术 ， 乘 客 的 很 多 信息 都 会 被 记录 并 且 上 传 云端 ， 比 如 通过 对 乘客 的 驾驶 路 线 进行 大 数据 分 析 就 很 容易 得 到 乘客 
的 家 庭 位 置 、 公 司 位 置 ， 如 果 车 上 具有 监控 设备 ， 那 么 乘客 的 身体 信息 如 外 貌 、 行 为 都 将 会 处 于 记录 之 中 。 每 一 辆 自动 驾驶 汽车 的 信息 均 是 整个 大 数据 的 
一 部 分 ， 俏 若 一 旦 丢失 、 盗 取 或 遭遇 黑客 入 侵 ， 此 类 信息 极 有 可 能 被 恶意 泄露 或 利用 。 上 ] 如 果 说 互联 网 时 代 是 人 人 知道 你 是 谁 的 话 ， 那 么 自动 驾驶 就 会 
变 成 人 人 知道 你 去 哪 。 

以 我 国 为 例 ， 对 于 现 有 的 个 人 隐私 权 在 宪法 、 刑 法 、 民 事 诉讼 法 、 民 法 等 法 律 均 有 保护 条 文 ， 比 如 “邮电 工作 人 员 私 自 开 拆 或 者 隐匿 、 毁 弃 邮 件 、 电 
报 的 ， 处 二 年 以 下 有 期 徒刑 或 者 拘役 ”【']， 就 是 对 公民 通信 隐私 权 的 保护 。 但 是 针对 公民 的 车 辆 行驶 记录 数据 的 丢失 、 资 取 等 行为 的 规范 存在 缺漏 ， 给 个 
人 隐私 的 保护 带 来 不 利 。 如 何 保护 当事人 关于 车 辆 所 有 信息 的 隐私 权 ， 不 被 大 公司 利用 或 者 被 盗 ， 是 未 来 该 领域 的 一 个 重要 议题 。 


[1] 《中 华人 民 共 和 国 刑法 》 第 二 百 五 十 三 条 。 


7.1.4 成 本 提高 市 来 的 挑战 


价格 因素 是 影响 自动 驾驶 推广 的 重要 因素 ， 由 于 对 环境 感知 的 要 求 ， 无 人 车 需要 加 装 很 多 昂贵 的 传感器 !1， 比 如 谷歌 公司 采用 的 由 Velodyne 公 司 开发 
的 激光 测 距 器 liDAR ( 见 图 7-1) ， 单 个 成 本 在 75000 美 元 左右 , 约 占 整个 无 人 车 成 本 的 50%。 此 外 还 有 昂贵 的 MU、 毫 米 波 雷达 等 传感器 。 面 对 如 此 高 昂 
的 成 本 ， 特 斯 拉 公 司 来 用 了 成 本 相对 低廉 的 环境 感知 传感器 ， 这 也 是 其 快速 批量 应 用 的 一 个 重要 条 件 ， 但 是 ， 随 着 巡航 状态 下 致 人 死亡 交通 事故 的 友 生 ， 
特 斯 拉 的 环境 感知 与 识别 传感器 的 配置 被 质疑 过 于 简陋 ， 在 判断 危险 境况 方面 存在 安全 漏洞 。 可 见 ， 为 了 提高 自动 驾驶 的 实用 性 和 安全 性 ， 过 高 的 成 本 也 
是 目前 的 障碍 之 一 。 





图 7-1 激光 测 距 器 iIDAR (图 片 来 源 Velodyne 公 司 官 网 ) 
[1] 根据 Business Insider 的 文章 《谷歌 无 人 驾驶 汽车 有 重大 进展 ， 关 键 部 件 成 本 下 降 逾 90%》 可 知 。 


7.1.5 汽车 厂商 和 互联 网 三 隘 合 作 上 的 挑战 


从 目前 发 展 来 看 ， 互 联网 企业 倾向 于 将 智能 汽车 定位 为 “最 大 的 移动 智能 终端 ”， 和 希望 能 够 借鉴 在 智能 手机 领域 的 成 功 经 验 ， 以 汽车 为 基础 构建 生态 
链 ， 通 过 推送 服务 和 更 新 来 实现 利益 的 最 大 化 ， 更 着 眼 于 与 客户 互动 珊 来 的 利益 ， 而 且 和 希望 汽车 更 具有 科技 感 ， 对 完全 目 动 驾驶 苑 满 期 望 和 信心 。 而 传统 
汽车 公司 普遍 着 上 腿 于 汽车 本 身 的 价值 ， 重 视 购买 硬件 的 客人 ， 对 车辆 本 身 的 安全 性 、 和 舒适 性 、 经 济 性 和 法 律 法规 极 其 重视 。 因 此 ， 两 类 企业 具有 天 然 的 竞 
争 性 ， 都 希望 能 够 主导 智能 汽车 的 发 展 ， 获 得 更 大 的 话语 权 ， 制 定 智能 汽车 的 标准 和 规划。 可见 ， 如 何 协调 两 者 之 间 的 竞争 与 合作 ， 从 而 开发 出 一 种 互利 
赢 、 双 方 都 能 接受 的 合作 模式 是 一 大 挑战 。 


并 


AN 


mu 


7.1.6 汽车 安全 的 挑战 


安全 与 可 靠 永远 是 智能 汽车 推广 道路 上 无 法 绕 过 的 门槛 ， 智 能 汽车 自身 的 安全 性 主要 包括 硬件 安全 、 软 件 安全 、 网 络 安全 和 公众 所 担心 的 可 靠 性 。 由 
于 智能 化 程度 较 高 ， 智 能 汽车 需要 更 多 的 电子 元 器 件 ， 因 而 更 容易 受到 环境 影响 而 失效 ， 比 如 基于 可 见 光 反射 原理 的 车 载 高 清 报 像 头 ， 容 易 受 到 强 光 干扰 
无 法 获取 真实 清晰 的 图 像 ， 车 载 信息 系统 遭遇 黑客 入 侵 、 破 解 、 超 控 ; 大 范围 病毒 发 作 导致 的 交通 事故 等 。 如 特 斯 拉 在 2016 年 5 月 发 生 过 一 起 ， 因 在 日 昭 
条 件 下 无 法 识别 白色 车 辆 的 事故 【8] ， 如 图 7-2 所 示 。 





图 7-2 ” 特 斯 拉 事 故 现场 图 片 


另外 ， 随 着 5G、WiFi 等 互联 网 通信 技术 被 逐步 应 用 在 智能 汽车 中 ， 汽 车 的 开放 性 程度 将 被 大 大 加 强 1]， 不 同 于 CAN 总 线 的 封闭 性 ， 未 来 的 智能 汽车 需 
要 将 车 辆 的 大 部 分 核心 控制 权 交 与 控制 器 ， 因 而 更 容易 被 破解 ， 可 见 智 能 汽车 的 安全 性 是 未 来 必须 面 对 和 解决 的 领域 之 一 |， 中 。 


[1] 2015 年 7 月 美国 《 连 线 》 杂 志 ，2016 年 7 月 来 福 车 (Lyft) 公司 罗 伯 ' 格兰特 (Rob ltrant) 的 来 访 。 


7.2 目 动 区 驶 给 人 类 市 来 的 变化 


智能 汽车 作为 一 种 新 的 技术 ， 不 可 避免 地 将 持续 冲击 着 传统 汽车 产业 ， 带 来 商业 模式 的 颠 桥 式 转变 ， 同 时 也 冲击 着 人 们 传统 的 思维 方式 ， 这 也 许 是 21 
世纪 汽车 行业 最 重大 的 变化 ?| 。 


7.2.1 市 场 份 额 变化 


全 球 汽车 2016 年 全 球 汽车 产销 量 创 历史 新 高 ， 产 量 达到 9498 万 辆 ， 销 量 达到 9386 万 辆 ， 而 中 国 汽车 产销 2811.88 万 辆 和 2802.82 万 辆 ， 同 比 增长 
14.46% 和 13.65%[1]。 而 根据 麦肯锡 预测 ， 智 能 汽车 到 2025 年 可 以 产生 2000 人 Z ~ 19000 亿 美元 的 产值 ， 到 2020 年 全 球 ADAS 市 场 预计 在 200 亿 ~ 300 亿 美 
元 【1] 。 可 以 预 出 ， 未 来 自动 驾驶 取代 人 工 驾驶 将 手 动 这 数 万 亿美 元 的 产业 ， 这 将 逐步 压缩 传统 汽车 的 空间 ， 使 得 未 来 汽车 产业 逐步 向 自动 驾驶 靠拢 ， 束 
个 生产 模式 也 许 会 发 生 改变 ， 


[1] 数据 来 自 《2017 一 2023 年 中 国 汽车 市 场 供需 预测 以 及 未 来 前 景 预测 报告 》。 


7.2.2 ”商业 模式 的 闫 复 


基于 目 动 驾驶 概念 和 出 行 万 式 ， 示 来 汽车 的 商业 模式 必定 会 友 生 改变 ， 上 自动 驾驶 与 互联 网 + 的 结合 将 会 极 大 改变 现 有 的 汽车 概念， 甚至 改变 现 有 的 物 
流 系统 、 交 通 系统 ， 实 现 现 代 公路 物流 的 全 自动 化 。 
同时 ， 目 动 驾驶 的 概念 与 共享 的 概念 完全 契合 。 调 查 显 示 ， 目 前 一 王家 用 汽车 90% 的 时 间 处 于 朵 置 状 态 ， 每 一 旺 共 享 无 人 竺 可 以 取代 11 辆 弟 规 汽 
只 增加 10% 的 运营 里 程 【1 人 。 所 以 笔者 大 胆 预 测 ， 未 来 个 人 汽车 将 逐步 消失 ， 共 享 汽车 和 无 人 公共 交通 将 完全 取代 现 有 的 交通 运输 方式 。 例 如 ， 乘 客 想 
用 最 快速 度 从 家 里 坐车 到 公司 上 班 ， 于 是 从 手机 或 者 智能 手表 定位 现 有 位 置 并 且 输 入 目的 地 ， 云 端 将 计算 出 最 佳 行驶 方案 ， 可 以 在 车 上 解决 早饭 或 者 做 自 
己 的 其 他 事情 ， 全 程 无 颖 连接 ， 路 上 畅通 无 阻 。 到 此 阶段 ， 传 统 汽车 的 商业 模式 束 将 改变 ， 实 现 类 似 于 摩 拜 单车 的 商业 模式 ， 整 车 三 的 目标 客 尸 也 将 从 个 
人 消费 者 变 为 互联 网 企业 。 


7.2.3 人们 思想 的 改变 


现在 很 多 国家 都 步 入 老年 化 ， 自 动 驾 驶 可 以 完美 解决 老年 人 和 残疾 人 的 出 行 问题 。 到 2050 年 美国 老龄 人 口 将 是 目前 的 两 倍 ， 达 到 8000 万 人 ， 占 总 人 口 
的 20%。 他 们 之 中 将 有 超过 三 分 之 一 的 人 面临 出 行 困难 [13] 。 中 国 老龄 化 人 口 占 总 人 口 的 34.1%[， 日 本 甚至 达到 了 45%。 四 那 时 ， 人 们 将 逐步 接受 智能 


汽车 ， 同 时 共享 的 概念 将 深入 人 心 ， 未 来 共享 无 人 车 将 逐步 得 到 人 们 的 支持 。 据 世界 经 济 论坛 的 一 项 调查 显示 ，“75% 的 中 国人 愿意 乘坐 无 人 车 ”而 
罗兰 公司 调查 报告 人 更 证 实 了 这 一 结果 ，“96% 的 中 国人 愿意 考虑 每 天 乘坐 无 人 车 ， 远 高 于 美国 与 德国 的 58%”。 所 以 可 以 想象 ， 未 来 人 们 对 自动 驾驶 将 


会 报 以 积极 的 态度 。 


[1] 中 国 市 长 协会 最 新 发 布 的 《中 国 城市 发 展 报告 (2015) 》。 

[2] 美国 彭 博 网 2015 年 10 月 28 日 文章 “Japan”s Carmakers Proceed With Caution on Self-Driving Cars ”， 作 者 为 蕊 杰 。 

[3] 密 歌 根 大 学 世界 可 持续 交通 研究 所 报告 “Motorists Preferences for Different Levels of Vehicle Automaton: 2016”， 作 者 为 Btandon Schottle 和 Micheal 
Sivak。 


[4] 《中 国 日 报 》2016 年 6 月 22 日 文章 “Officials Want to Open Way for Autonomous Driving 。 


7.3” 吞 论 ) 气 车 友 展 策略 


开展 智能 汽车 系统 研究 ， 应 立足 于 信息 技术 和 控制 技术 ， 对 核心 扩 术 进行 突破 ， 由 于 智能 汽车 的 研究 是 多 学 科 续 合 与 交叉 应 用 的 边缘 领域 ， 涉 及 人 工 
智能 (Artificial Intelligent Theory) 、 信 息 论 (Information Theory) 、 控 制 论 (Control Theory) 以 及 决策 论 (Decision Theory) 等 理论 的 综合 ， 还 
涉及 计算 机 技术 、 微 电子 扩 术 、 网 络 撤 术 、 通 信 技 术 以 及 车 辆 控制 等 撤 术 的 应 用 。 所 以 从 总 体 上 分 析 ， 智 能 汽车 的 研究 是 从 信息 系统 、 识 别 系 统 、 控 制 系 
统 等 几 方面 进行 的 。 


7.3.1 -信息 系统 


智能 汽车 通信 系统 的 任务 束 是 保证 信息 的 准确 快速 传输 。 在 智能 汽车 与 智能 汽车 之 间 、 智 能 汽车 与 交通 监控 中 心 之 间 、 智 能 汽车 与 道路 附属 设施 之 
间 、 智 能 汽车 与 其 他 信息 系统 之 间 ， 都 存在 着 大 量 的 文字 、 语 音 、 数 据 、 图 像 等 信息 的 实时 交换 。 通 信 系统 是 智能 汽车 系统 获取 和 传递 信息 的 神经 中 枢 ， 
我 们 必须 研究 适合 于 智能 汽车 信息 交换 的 通信 系统 结构 形式 、 软 件 拷 术 、 传 输 介 质 、 编 码 纠 错 技 术 等 。 通 信 系 统 保证 了 各 模块 之 间 以 及 车 载体 与 控制 中 心 
之 间 的 高 质量 通信 ， 目 前 大 多 及 用 无 线 数字 通信 。 


相对 于 传统 通信 技术 ， 智 能 汽车 所 使 用 的 车 间 通 信 要 求 的 覆盖 范围 更 大 ， 同 时 还 能 够 有 效 避免 盲区 ， 保 证 通信 的 实时 性 和 可 靠 性 。 所 以 ， 未 来 自动 驾 
驶 信息 系统 的 发 展 策略 ， 一 定 是 融合 多 种 通信 技术 的 策略 ， 具 体 做 法 则 是 根据 不 同 的 车 辆 通信 要 求 将 会 使 用 到 不 同 的 模块 ， 比 如 未 来 车 辆 内 部 通信 还 是 使 
用 的 总 线 技术 、 蓝 牙 技术 ， 车 间 通 信 将 会 使 用 DSRC 或 者 未 来 的 5G 通 信 等 ， 车 云 通信 将 会 使 用 WiFi、5G 通 信 等 


7.3.2 ”识别 系统 


智能 汽车 识别 系统 要 求 能 够 快速 、 准 确 地 识别 环境 。 因 此 ， 人 研究 智能 汽车 系统 的 信息 环境 模型 、 信 息 源 特征 、 信 息 米 集 原理 与 技术 、 信 息 处 理 万 法 、 
言 息 传输 技术 与 子 系统 ， 就 显得 尤其 重要 。 为 此 需要 对 包括 LiDAR、GPS、IMU 等 在 内 的 多 源 传 感 器 信息 进行 融合 和 容错 处 理 ， 保 持 识别 系统 的 可 靠 工 
作 。 同 时 ，3 引 入 卷 积 神经 网 络 等 人 工 智能 算法 ， 尽 可 能 地 完善 识别 算法 的 准确 性 和 可 靠 性 ， 实 现 包括 车 辆 自身 状况 信息 、 乘 客 信 息 、 道 路 信息 、 近 邻 行驶 


汽车 的 信息 及 导航 定位 等 信息 的 有 效 辨识 。 


笔者 预测 未 来 的 自动 驾驶 的 感知 部 分 友 展 策略 趋同 多 传感器 多 路 径 融 合 。 原 本 的 上 自动 驾驶 感知 部 分 明显 分 为 两 条 路 线 : 一 条 路 线 是 以 谷歌 、 百 度 、 

Otto 为 主 、 以 激光 雷达 为 主要 感知 设备 的 土豪 方案 ， 另 一 条 路 线 是 以 Tesla、Mobileye、Cruise 以 及 国内 大 多 数 自 动 驾驶 的 初创 公司 为 主 、 以 视觉 为 主 的 
性 价 比 高 方案 。 一 方面 深度 学 习 的 发 展 使 得 基于 计算 机 视 党 为 主 的 方案 成 为 热点 ， 另 一 方面 特 斯 拉 对 AutoPolite 的 过 度 宣传 导致 的 重大 事故 ， 使 得 人 们 意 
识 到 安全 间 题 是 不 能 计较 成 本 的 ， 这 总 味 着 传感器 必须 是 多余 ， 加 之 随 着 硬件 技术 的 达 代 和 制造 工艺 的 升级 ， 未 来 激光 雷达 的 降价 似乎 是 必然 ， 而 能 够 给 
出 高 精度 3D 操 云 的 激光 雷达 在 安全 万 面 具有 重大 的 优势 。 同 时 ， 互 联 化 市 来 的 车 辆 间 的 通信 使 得 车 辆 之 间 的 非 环境 感知 识别 成 为 可 能 ， 比 如 某 车 辆 通过 
DRSC 的 车 辆 之 间 通 信 束 可 以 直接 知道 廊 贺 300m 范 围 内 所 有 和 车辆 的 位 置 ; 高 精度 地 图 也 可 以 直接 获得 车 辆 附近 的 环境 参数 ， 从 而 辅助 计算 机 完成 环境 感 
知 。 因 此 ， 未 来 自动 驾驶 识别 的 技术 路 线 不 仅 是 通过 摄像 涉 、Lidat 等 环境 感知 传感器 融合 的 识别 ， 同 时 还 利用 通信 技术 、 高 清 地 图 技术 等 多 种 技术 路 径 融 
合 ， 从 而 准确 、 快 速 地 实现 环境 识别 。 


7.3.3 ”控制 系统 


目前 ， 智 能 控制 理论 的 研究 已 有 30 年 的 历史 ， 已 经 提出 了 模糊 控制 理论 、 神 经 控制 理论 、 专 家 控制 理论 、 分 层 违 阶 控 制 理论 、 粗 糙 集 控制 、 可 拓 控 制 
等 万 案 ， 并 正 向 综合 智能 控制 荣 略 的 方向 友 展 。 所 有 这 些 智 能 控制 策略 的 核心 思想 残 是 “模仿 人 的 思维 和 行动 ”， 去 完成 或 部 分 完成 只 有 人 类 专家 才能 完 
成 的 控制 任务 。 


因此 ， 未 来 智能 汽车 控制 系统 友 展 策略 必须 以 现代 向 电子 技术 为 核心 来 设计 系统 硬件 ， 以 智能 控制 理论 为 基础 来 设计 控制 策略 ， 以 信息 技术 为 支撑 来 
设计 系统 框架 ， 发 展 包 括 人 工 智 能 等 在 内 的 先进 控制 方法 。 


7.4 可 预见 的 未 来 


在 不 远 的 未 来 ， 道 路 上 行驶 的 车 辆 将 全 部 都 是 智能 汽车 ， 与 此 同时 一 个 智能 交通 系统 形成 。 可 以 畅想 ， 未 来 的 世界 将 是 如 此 高 效 、 安 全 ， 在 本 节 我 们 
按照 时 间 的 顺序 来 预测 未 来 无 人 车 的 友 展 。 


7.4.1 关键 的 节操 : 2020 年 


各 大 汽车 厂商 和 各 大 互联 网 企业 都 投入 了 智能 汽车 产业 ， 并 且 宣 称 2020 年 左右 自动 驾驶 车 辆 能 够 量 产 ， 比 如 国外 的 谷歌 、 沃 尔 沃 ， 国 内 的 百度 
等 [1 和， 这 说 明了 自动 驾驶 的 商业 前 景 十 分 诱 人 ， 而 且 已 经 成 为 大 趋势 。 有 无 数 人 投入 到 自动 驾驶 产业 ， 优 达 学 城 (Udacity) 最 近 开设 了 自动 驾驶 课 
程 ， 将 培训 有 4000 名 左右 的 自动 驾驶 工程 师 。 基 于 这 几 点 ， 我 们 预测 到 2020 年 ， 多 款 无 人 车 将 上 市 ， 不 过 究竟 能 得 到 多 少 市 场 认 可 还 有 待 检验 ， 不 过 笔者 
预 估 这 批 汽车 应 该 可 以 手动 驾驶 ， 是 处 于 L3 级 别 的 汽车 ， 具 有 自动 驾驶 模式 ， 可 以 作为 市 场 试 水 产品 ， 也 许 价格 比较 高 ， 各 大 汽车 厂 将 会 把 自动 驾驶 首先 
运用 在 中 高 档 汽车 上 。 在 这 方面 ， 奥 迪 走 在 了 前 沿 ， 最 新 款 的 奥迪 A8 安 装 了 “Audi AI” 系统， 具备 允许 驾驶 员 双 手 离开 方向 盘 的 自动 驾驶 功能 ， 达 到 了 
L3 级 别 。 


7.4.2 混合 时 代 : 2020 ~ 2050 年 


机 动车 的 设计 使 用 寿命 是 10 ~ 15 年 ， 考 虑 到 目前 技术 上 和 和 法律 上 的 困境 ， 同 时 根据 人 们 对 自动 驾驶 的 接受 程度 ， 这 一 时 期 应 该 是 自动 驾驶 和 人 工 驾 驶 
共存 的 时 代 ， 这 一 时 期 的 无 人 驾驶 被 设计 为 能 够 理解 并 处 理 传 统 的 面向 人 为 驾驶 的 交通 系统 ， 交 通 灯 、Lanes、Stop Sign 等 将 进一步 装备 路 感应 器 ， 以 更 
好 地 辅助 无 人 驾驶 171] 。 


另外 ， 这 一 时 期 应 该 是 自动 驾驶 最 天 键 的 帮 展 时 期 ， 由 于 道路 、 驾 驶 环境 空前 的 复杂 性 ， 自 动 驾驶 在 这 段 时 期 的 争议 也 会 变 得 最 大 ， 各 国法 律 法 规 的 
完善 也 是 在 这 段 时 期 。 


7.4.3 真正 的 目 动 雪 驶 时 代 : 2050 年 以 后 


到 2050 年 以 后 ,不 出 意料 街 上 行驶 的 全 部 都 会 是 新 能 源 的 智能 互联 网 汽车 。 人 为 驾驶 将 逐渐 只 能 从 赛车 比赛 里 面 看 到 ， 而 道路 上 的 手动 等 驶 将 会 不 复 
存 企 。 到 那个 时 候 ， 汽 车 的 路 径 将 完全 根据 数据 中 心 规划 好 ， 甚 全 有 可 能 未 来 人 们 将 不 会 购买 汽车 ; 汽车 模式 将 会 被 目 动 驾驶 + 网 络 租 后 模式 蔡 代 。 想 旬 
一 下 ， 当 你 想 要 出 行 时 通过 手机 或 者 智慧 手表 将 上 自己 位 置 定位 同时 输入 想到 达 的 地 方 以 及 上 车 时 间 ， 然 后 这 个 数据 进入 数据 中 心 ， 然 后 电脑 束 能 精确 配置 
汽车 资源 设置 最 佳 路 线 ， 你 只 需要 和 直接 上 和 车 束 可 以 了 ; 同时 在 车 上 你 可 以 做 目 己 的 事情 ， 可 以 娱乐 也 可 以 工作 ， 这 样 社会 效率 将 达到 最 大 化 ， 社 会 能 耗 和 


社会 污染 将 达到 最 低 。 
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